MASSACHUSETTS INSTITUTE OF TECHNOLOGY 
ARTIFICIAL INTELLIGENCE LABORATORY 

A.I. Technical Report No. 1563 January, 1996 

Parallel Coupled Micro- Macro Actuators 

John Bryant Morrell 

This publication can be retrieved by anonymous ftp to publications.ai.mit.edu. 

Abstract 

This thesis presents a new actuator system consisting of a micro- actuator and a macro- 
actuator coupled in parallel via a compliant transmission. The system is called the Parallel 
Coupled Micro-Macro Actuator, or PaCMMA. 

In this system, the micro-actuator is capable of high bandwidth force control due to 
its low mass and direct-drive connection to the output shaft. The compliant transmission 
of the macro-actuator reduces the impedance (stiffness) at the output shaft and increases 
the dynamic range of force. Performance improvement over single actuator systems was 
expected in force control, impedance control, force distortion and reduction of transient 
impact forces. 

A set of quantitative measures is proposed and the actuator system is evaluated against 
them: Force Control Bandwidth, Position Bandwidth, Dynamic Range, Impact Force, 
Impedance ("Backdriveability"), Force Distortion and Force Performance Space. 

Several theoretical performance limits are derived from the saturation limits of the 
system. A control law is proposed and control system performance is compared to the 
theoretical limits. A prototype testbed was built using permanenent magnet motors and 
an experimental comparison was performed between this actuator concept and two single 
actuator systems. 

The following performance was observed: Force bandwidth of 56Hz, Torque Dynamic 
Range of 800:1, Peak Torque of 1040mNm, Minimum Torque of 1.3mNm. Peak Impact 
Force was reduced by an order of magnitude. Distortion at small amplitudes was reduced 
substantially. Backdriven impedance was reduced by 2-3 orders of magnitude. 

This actuator system shows promise for manipulator design as well as psychophysical 
tests of human performance. 
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Nomenclature 



B t = transmission damping 
B t = environment damping 

F\ = force command to micro-actuator 
F\ sat = Saturation force of micro-actuator 
_F 2 = force command to macro-actuator 
Fisat = Saturation force of macro-actuator 
F,i es = Desired force 
F e = Force applied to environment 

^ error — rOrce error, T des -^e 

F macro = Force applied to Mi by macro-actuator via transmission 
F m i cro = Force applied to Mi by micro-actuator 

Gdi = Velocity gain - transmission 

G,i2 = Velocity gain - macro-actuator 

Gff = feedforward gain 

Gi = Integral gain 

G p = Gain of Micro-actuator effort 

G v = Force rate gain 

H\cl{ s ) = Closed loop transfer function from u\(s) to F m i cro (s) 
H\ol{ s ) = Open loop transfer function from u\(s) to F m i cro (s) 
H2Cl{ s ) = Closed loop transfer function from ^(s) to F macro (s) 
H20l{ s ) = Open loop transfer function from ^(s) to F macro (s) 
Hf c (uj) = Closed loop transfer function from F^es to F e . 
K e = Environment stiffness 
K t = transmission stiffness 

Mi = Mass of micro-actuator 
M2 = Mass of macro-actuator 

xi = position of Mi 
x 2 = position of M 2 
Xi n = Position input 



11 



12 NOMENCLATURE 

u\ = command input to micro-actuator 
u 2 = command input to macro-actuator 

uj = driving frequency 

uj 1co = roll-off frequency of H\cl{s) 

tjj 2c o = roll-off frequency of H2Cl( s ) 

Z(s) = Impedance response 



Chapter 1 

Introduction 



Robot manipulation has been a topic of research for at least thirty years. During that 
period robot performance has improved and robots have surpassed human performance in a 
variety of tasks, especially those that require position accuracy and accurate repeatability. 
Despite these successes there are a large number of manipulation tasks which humans still 
perform faster and more accurately than robots such as picking up an unknown object or 
re-orienting an object in the hand. 

Study of robot tasks typically breaks down into two distinct research problems. The 
first is using sensory information to determine an appropriate action and the second is using 
some manipulation system to execute the desired action. This thesis focuses on work in the 
latter of these areas. In examining the hardware and control algorithms available to higher 
order planners, it becomes clear that much of the existing robot hardware has performance 
characteristics which are quite different from those of humans. 

In position controlled robots the ratio of the maximum to the minimum controllable 
displacement (position precision) can exceed 10,000:1 with standard actuators and sensors. 
For force controlled robots, the ratio of the maximum to the minimum controllable force 
remains quite small (50:1 or 0.02% for electric motors) and force accuracy remains relatively 
poor despite the existence of high accuracy force sensors. 

Human resolution is fundamentally different from that of machines because it is loga- 
rithmic (Weber's Law (Gescheider, 1985)). For force control and sensing, the resolution of 
the measurement depends on the magnitude of the force and is usually about 7-10% JND 
(Just Noticeable Difference). That means that humans can detect a 7 lb change in a 100 
lb load or a 7 gm change in a 100 gm load, but not a 7 gm change on a 700 Kg load. As a 
result, a human finger can control forces on the order of 1-2 grams with the same finger used 
for tasks requiring forces of one kilogram. The dynamic range of force allows the finger to 
perform very delicate sensing tasks as well as high force manipulation tasks. The principle 
of logarithmic resolution is also born out in position control. Humans can detect differences 
in position with resolution that is a fraction of the total displacement. A quick comparison 
of the performance of machines and humans suggests that humans have a larger force range 
than machines, while machines have a larger position range. 

Another relevant aspect of human performance is the way human limbs accommodate 
position errors. As mentioned above, human position resolution from kinesthetic sensing 
(the location and forces of the limbs) is not nearly as accurate as most machines. Most 
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humans improve position resolution using vision and touch and we perform many position 
tasks with great precision. In the absence of vision, position sensing performance is much 
lower and yet many tasks can be accomplished successfully. The characteristics of human 
actuators are clearly quite different from machine actuators. Since humans are quite adept 
at manipulation it is worth examining these characteristics. 

A fundamental requirement for manipulation is the ability to make and break contact 
with the environment in a stable, non-destructive way. In a controlled environment this is 
typically accomplished by knowing the exact location of various objects and moving slowly 
and precisely when contact is imminent. When contact does occur the forces of interaction 
are dependent on the mass and stiffness of the object and the manipulator and the impact 
velocity. The manipulator's mass and stiffness properties can be described more compactly 
as impedance. Large impedances (very stiff or massive) will generate large contact forces 
for small position disturbances, which is not desirable. A system with low impedance will 
generate smaller forces for the same conditions. 

I believe human actuators rely on two important qualities for manipulation. The first 
is low impedance. Humans routinely move in both free-space and in constrained motion 
trajectories with stability in all regions, despite using low frequency actuators. For example, 
a human can absorb impacts energy by keeping the arms and legs bent. The success of 
these operations relies on low impedance. While human position performance is slow and 
inaccurate compared to machines, human impedance characteristics are superior for tasks 
where position errors are likely. 

The second quality is dynamic range. Humans are able to sense features and acquire 
information during manipulation through use of a wide range offerees. Locating a feature 
may require a small force, use of a tool may require a large force. The versatility of many 
machines is limited by their force range. A surface profilometer can measure extremely 
small displacements but can not be used as a manipulator. Conversely, a PUMA robot can 
be used to lift a brick but could not detect its surface features. 

This thesis will present a new concept for a Parallel Coupled, Micro-Macro Actuator 
(PaCMMA) which is motivated by the difficulties encountered in robot manipulation. The 
remainder of this chapter is devoted to background material on actuator and manipulator 
design and control. The actuator concept is presented in Chapter 2. Chapter 3 presents a 
number of performance metrics that are useful for actuator systems. Chapter 4 presents a 
model of the actuator system and a number of performance bounds. The model provides 
insight into ways to use the PaCMMA concept to its fullest capacity. Chapter 5 presents 
a control law and evaluates the control law's effectiveness. Chapter 6 presents some design 
guidelines which help a designer translate performance specifications into specifications 
for the individual system elements. Chapter 7 presents the results of a large number of 
experiments using the prototype system. The data here provide a good visual understanding 
of the system performance as well as some insight into the kinds of unmodelled effects that 
will affect performance. 

In the process of designing and evaluating this actuator, it became clear that actuator 
technologies have various strengths and weaknesses and that the most common performance 
metrics fail to capture the important characteristics of actuators used in manipulation. The 
following section addresses some of these concerns. The remainder of this chapter provides 
background material for the reader. A substantial amount of research has been done in 
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the area of manipulation and the resulting paradigms for control and design influenced this 
thesis heavily. 



1.1 Understanding Actuator Performance 

Actuator performance may be quantified in a number of ways. Inspection of data sheets 
from various manufacturers identifies several important specifications: saturation force, 
maximum speed, inertia, power dissipation, etc. Sensor specifications such as resolution, 
range, and linearity affect the performance of a given actuator as well. Finally, the choice 
of control system affects the performance. Both the dynamic behavior of the control law 
and the implementation of the control architecture (servo rate, a/d resolution, etc.) will 
have a significant effect on system performance. Selection of an actuator system and its 
components should incorporate all of these specifications in a manner which allows the 
designer to achieve the desired performance. 

In most cases the designer thinks in terms of the task to be performed by the robot and 
wants to translate the task requirements into component specifications. When considering 
actuators and sensors for robotic tasks, it is useful to consider the performance metrics in 
Table 1.1. 



Quasi-Static Properties 

of the Actuator and Sensors 



Dynamic Properties 

of the Actuator and Sensors 



Quasi-Static Properties 
of the Controlled System 



Dynamic Properties 

of the Controlled System 



Peak Force (Transient - lOmsecs) 
Peak Force (Continuous - Smoke test) 
Force Resolution 
Position Resolution 



Inertia 

Maximum Acceleration (peak force/inertia) 



Force Precision (controllable force) 
Position Precision (controllable Position) 
Force Dynamic Range 



Position Bandwidth 
Force Bandwidth 
Impedance (backdrivability) 
Range of controllable impedances 
Distortion (RMS) 



Table 1.1: Actuator Performance Specifications 
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At the component level most of these specifications are easy to understand. Once the 
system is assembled and a controller is chosen the Dynamic Properties of the Controlled 
System become important metrics. Unfortunately, the mapping from performance metrics 
above into component specifications is poorly defined. The performance of the system 
is highly dependent on implementation and non-ideal effects. Friction and backlash can 
introduce force and position errors; quantization noise and time delays can destabilize a 
control system. Fortunately, it is generally possible to predict, simulate, or measure the 
performance of a given set of components and the fourth set of metrics provides a basis for 
performing experiments to assess the performance of the actuator system. This thesis will 
define some of these metrics and present experimental techniques for measuring them. 

1.2 Background 

Robot manipulation tasks have typically been specified as a collection of force and posi- 
tion trajectories and/or impedances at the robot endpoint. The ability to control position 
accurately in the presence of force disturbances has been studied extensively and is well 
understood. Controlling forces in the presence of position disturbances has been signif- 
icantly harder than achieving accurate position control. Often, analysis of manipulation 
and impedance control assumes that the robot will accurately produce the desired force. 
Experimental success has been limited and force control in the real world has become a 
significant research area in robot control. 

The following sections provide a brief overview of past control approaches, design paradigms 
and technologies. 

1.2.1 Robot Design Issues 

Robot Impedance 

Early work in force control identified two significant robot characteristics which make con- 
trolling force difficult. The first is robot impedance (Salisbury, 1980; Salisbury and Craig, 
1982; Hogan, 1983; Hogan, 1985; Khatib, 1990; Sharon et al., 1988), and the second is non- 
collocation of the force sensor and the actuator (An, 1986; Cannon and Rosenthal, 1984; 
Eppinger and Seering, 1987). Robot impedance is of obvious importance. When a robot 
with high impedance (large mass or stiffness) is in contact with an object, a small displace- 
ment of either the robot or the object will result in large contact forces. The large forces 
can result in damage to both the robot and the object. Thus, successful force control relies 
on the ability of the robot to control the contact impedance. This may be accomplished 
with active control or through passive characteristics. 

Robots with active control have the benefit that the impedance may be changed as the 
task changes. Unfortunately, active control is limited by the bandwidth of the controlled 
system and by the intrinsic mechanical properties of the system, e.g. stiffness, mass, natural 
frequency etc. Digital control systems are inherently discontinuous due to sensor resolution 
and quantization noise and can introduce errors or destabilizing noise. The servo period adds 
delay which can also destabilize the system. In a stiff environment position disturbances 
create force transients that can rise significantly in one or two servo cycles, leading to limit 



1.2. BACKGROUND 17 

cycles or instability. Nonlinearities such as saturation and friction turn well-behaved linear 
systems into ill-behaved non-linear systems and all of these nonlinearities inevitably become 
performance limiting factors in robot force control. 

Chosen properly, passive characteristics can have the benefit of requiring little control 
effort and exhibiting real-time continuous response, but they can not usually be modified 
dynamically. For force control, good passive characteristics include low robot inertia, well- 
damped dynamics and frictionless, zero-backlash transmissions. Studies on remote center 
of compliance are an example of this approach (Whitney, 1982) while the work in (Laurin- 
Kovitz et al., 1991) suggests some approaches to utilizing programmable passive elements. 
Morita also suggests the use of passive mechanical elements which may be altered using 
computer control to change the robot impedance (Morita and Sugano, 1995). 

The Whole- Arm-Manipulator at MIT is an excellent example of a robot with naturally 
low impedance (Salisbury et al., 1989). In this case the motors are located near the base of 
the robot and connected to the links via efficient, low reduction ratio cable transmissions. 
Force control is achieved through open loop torque commands to the motors. Disturbance 
rejection relies on low mass links and the low friction transmission. This works well but the 
disturbance rejection in force is limited since the force control is open loop. 

No n- collocated Sensors 

Non-collocation of the sensor and actuator is another dominant problem in force control 
(Cannon and Rosenthal, 1984; Eppinger and Seering, 1987; Colgate and Hogan, 1989). 
If the sensor and actuator are separated by several dynamic elements, then the obtainable 
control bandwidth is limited by the resonant frequencies of the system usually a transmission 
between the sensor and actuator . The stiffer the transmission, the higher the potential 
control bandwidth. This fact has led many designers to conclude that "stiffer is better". 
Further, friction and backlash combine to lower the control bandwidth in these situations as 
well. Electric motors and many other actuators require some kind of transmission to both 
maximize torque and to move actuator mass away from the endpoint. As a result robot 
design has moved in two directions: 1) direct drive actuators and 2) stiffer, low friction, low 
backlash transmissions. 

Direct Drive Actuators 

Direct drive actuators solve the non-collocation problem by providing a stiff connection 
between the force source and the sensor (H. Asada and Takeyama, 1983). This approach 
exhibits relatively high bandwidth force control (20-60Hz). The absence of a transmission 
reduction keeps the link inertia at a low value. (Recall that a reduction has the effect of 
multiplying the motor inertia by A 2 , where A is the reduction ratio (Townsend, 1988)). 
The negative aspect of this approach is that the motor is not being used at its maximum 
power. Consequently, a much larger actuator must be used to get the same torque from a 
direct-drive system. A further consideration is the increased mass of the preceding joints 
due to the motor housing mass. Nonetheless, the low rotor inertia and stiff transmission 
of direct-drive actuators has been shown to provide superior force control performance for 
quasi-static environments and unforeseen impacts (Youcef-Toumi and Li, 1987; An and 
Hollerbach, 1987). 
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Macro-micro robots 

Macro-micro robots in the past have been implemented in a serial configuration. In these 
cases, a micro-robot is mounted on a macro-robot so that their positions are summed. Since 
they are connected in a serial manner, the forces in the macro and micro-robots must be 
equal in steady state. A number of researchers have studied the control issues in these types 
of manipulators. 

Some of the first work in macro-micro systems is reported in (Sharon and Hardt, 1984; 
Sharon et al., 1988; Sharon et al., 1989; Sharon et al., 1993). Sharon shows that force control 
bandwidth and position control bandwidth may be improved using a serial configuration 
and reports on the control issues associated with the serial configuration. 

Khatib showed that a macro-micro system may be used to reduce endpoint inertia to 
the inertia of the micro-actuator alone (Khatib, 1990). 

Cannon reports on a micro-manipulator attached to a flexible arm. Position control 
bandwidth was achieved at a frequency 8 times higher than the first structural mode of the 
flexible arm (Chiang et al., 1991). 

A compliant, serial macro-manipulator with a fast, stiff micro-manipulator is studied in 
(Yoshikawa et al., 1994a; Yoshikawa et al., 1994b; Nagai and Yoshikawa, 1994). Position 
control of several other serial macro-micro mechanisms are explored in (Narikiyo et al., 
1994; Salcudean and An, 1989). 

Compliant Manipulators 

The intentional use of compliance for manipulation has been identified as early as 1975 
(remote center of compliance) (Drake, 1975). 

Trevelyan describes a sheep shearing robot in (Trevelyan, 1993). The robot relies on 
effective open loop dynamics rather than using an extensive control system. The author 
reminds us that machines should be designed to work correctly in an open loop capacity and 
that closed loop control should be introduced only if open loop performance is inadequate. 

Many robot arms are flexible because weight constraints prohibit additional material 
(space manipulators for example). A large body of research on the control of flexible 
structures exists though these structures have not always been used for manipulation. Some 
of the relevant research issues are addressed in (Cannon and Rosenthal, 1984; Chiang et al., 
1991) and an interesting design for an elastic arm and controller is provided in (Park, 1992). 

Morita reports on the use of a device which adjusts the mechanical impedance of a one 
degree-of-freedom robot (Morita and Sugano, 1995). 

More recently, several researchers who study the interaction of walking and hopping 
robots have pointed to the benefits of compliance which include greater shock tolerance 
(impact tolerance) and better force control (Raibert et al., 1989; Pratt and Williamson, 
1995; Williamson, 1995). 

Actuator Research 

Robot designers have also sought improvement from developments in component technolo- 
gies. Integration of an actuator and force sensor is described in (Boulet and Hayward, 1993; 
Henri and Hollerbach, 1994; Grant and Hayward, 1995; Williamson, 1995) and a useful sur- 
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vey of a wide range of technologies is reported in (John M. Hollerbach and Ballantyne, 
1991). 

A consistent problem in actuator technology is the definition of useful performance 
metrics which allow a designer to evaluate candidate technologies. Jacobsen proposes several 
criteria in (Jacobsen et al., 1989) including positional accuracy, positional quickness, force 
generation quickness, saturation avoidance, and stability margin. Hayward proposes several 
criteria specifically for haptic interface devices, but these criteria may be easily applied to 
actuators as well (Hayward and Astley, 1995). These include some of the ideas mentioned 
in table 1.1. 

The field of haptics a recently begun to quantify the important performance metrics in 
robot performance. Several papers identify the importance of impedance, backdrivability, 
damping, dynamic range and sensor resolution (Colgate and Brown, 1994; Hayward and 
Astley, 1995; Rosenberg and Adelstein, 1993). 

1.2.2 Control Algorithms 

Control algorithm research has yielded several important results for control of robots in ma- 
nipulation. Force control was first studied as a means for performing peg-in-hole insertions. 
Other tasks of interest include surface following (such as sanding or window washing) and 
manipulation in less structured environments. Tasks like these typically have a number of 
phases including: moving in free space, making contact with the environment, and main- 
taining some kind of impedance or force control relationship with the environment. Good 
performance in these tasks is typically quantified by fast approach velocity, low impact 
force, and low bounce. It is not clear whether a single controller may be used for all phases 
of these tasks, but progress has been made identifying good controllers for each of these 
phases. The research in these areas may be broadly classified as Force Control, Impedance 
Control and Impact or Transition Control. 

Force Control 

Force Control is a broad topic and many algorithms have been proposed. This section 
provides a list of appropriate papers for further study. 

A history of early force control methods is presented in (Whitney, 1982). Goldenberg 
provides additional insight in (Goldenberg, 1992) and points out than many algorithms re- 
duce to full state feedback when linear models are used. Countless researchers have reported 
that stiff environments and full-state feedback result in instability. Several researchers pro- 
pose integral feedback of force errors with very good results (Colgate and Hogan, 1989; 
Levin, 1990; Volpe and Khosla, 1992; Richter and Pfeiffer, 1991; Paljug et al., 1992). 

In many cases the improvements in force control algorithm performance can be at- 
tributed to implementation and hardware issues, more than to control architecture. A com- 
monly overlooked issue is inaccuracy in the actuator model (Paljug et al., 1992). Several 
papers address the use of control strategies to deal with nonlinear or non-ideal characteris- 
tics of actuators (Xu et al., 1993; Qian and DeSchutter, 1992b; Qian and DeSchutter, 1992a; 
Wilfinger et al., 1993). Friction, backlash, saturation, and quantization noise, to name a 
few, will reduce system performance. For high performance, these kinds of nonlinearities 
must be addressed in the design of both the hardware and control system. 
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Impedance Control 

Impedance control is a more general case of Force Control. Nearly all systems may be char- 
acterized by some kind of mechanical impedance or admittance. The robot is programmed 
to exhibit an impedance based on the task. Hogan suggests the use of impedance as a 
general way of thinking about contact interactions (Hogan, 1985). For instance, if the task 
is based on position control, the robot might be programmed to be very stiff. If the task 
involves contact with an object, a specific stiffness and damping may be required. Control 
of the impedance may be achieved a number of ways. 

The interface between the manipulator and the environment should be viewed as a 
dynamic one, regardless of the actual control law. Given measurements of position, velocity 
and acceleration, and given an accurate force source, impedances may be generated actively 
by computing the appropriate force based on the position and its derivatives. In principle, 
it does not matter whether the force is generated using closed loop control or by open 
loop commands. Salisbury proposed a control law which created a programmable stiffness 
for a multi-degree of freedom hand (Salisbury and Craig, 1982) using open loop torque 
commands. The Whole Arm Manipulator also utilizes this approach (Salisbury et al., 
1989). 

A large number of researchers have studied the impedance control problem and as 
pointed out in (Goldenberg, 1992), (Wada et al., 1994), many control laws reduce to 
full-state feedback. As a result, many of the results that are reported are highly dependent 
on implementation issues of hardware and software (Glosser and Newman, 1994; Zhen and 
Goldenberg, 1994; Liu and Goldenberg, 1991; Colgate and Brown, 1994; Johansson and 
Spong, 1994; Kazerooni, 1985; Liu and Goldenberg, 1994; Seraji, 1994). 

Impact or Transition Control 

Control of a manipulator in free space is well understood. When contact is made with an 
environment of unknown dynamics the dynamic equations change. Several researchers have 
been studying the control of the transition from free-space to contact (and the impact that 
defines this transition). The use of integral feedback is proposed in (Youcef-Toumi and 
Gutz, 1989; Volpe and Khosla, 1993). 

Xu reports some of the difficulties in controlling unexpected contact transitions (Xu 
et al., 1994). These include the change in dynamics associated with contact, the large force 
transients that occur during impact, the limits of position sensing in stiff environments 
and the usefulness of pre-filtering commands to the actuator. Interestingly, humans do not 
suffer from the same kinds of problems. 

Research presented in (Hyde and Cutkosky, 1993) uses knowledge of the impact dynam- 
ics to shape the input. The control input can be "shaped" to avoid frequencies which excite 
the system dynamics. 

1.3 Discussion 

The work done in control algorithms and robot design has produced many useful results. 
Control research has made significant progress on the theoretical issues facing manipulator 
control and has identified many of the physical characteristics which make manipulation 
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difficult. Algorithms for controlling position, force and impedance under various conditions 
have been developed and proven to be effective on real systems. However, the non-ideal 
properties of robot hardware can have a large influence on control law efficacy. Often 
times the differences in the performance of various systems can be traced to their hardware 
characteristics. 

Research on robot design has produced a number of designs which circumvent some 
of the non-ideal characteristics which were identified in the control literature. Reduction 
of endpoint impedance and transmission friction along with increased power density have 
produced a number of interesting designs which have shown improvement in various kinds 
of tasks. 
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Chapter 2 

The Parallel Coupled 
Micro- Macro Actuator 



The actuator design constraints mentioned in the section 1.2.1 have limited performance 
of robot hardware to date. In this section a new design which overcomes some of these 
problems is presented. 

Figure 2-1 shows a schematic of this actuator concept. A large actuator is coupled via a 
compliant transmission to the joint axis. A micro-actuator is directly coupled to the joint 
axis. We refer to this concept as a Parallel Coupled Micro-Macro Actuator (PaCMMA- 
pronounced "Pack-ma"). 



a 




End Effector 



Micro Actuator ^Wf Torque Sensor 
Macro Actuator J^TComphant Transmission 



Figure 2-1: The Parallel Micro-Macro Actuator Concept 



Consider the case where the stiffness of the transmission is zero, i.e., the micro-actuator 
is the only force acting on the output link. In this case force control may be achieved at 
high bandwidth due to the proximity of the sensor and the actuator. The lower limit on 
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controllable force is on the order of the brush friction, which results in a limit cycle or 
constant error. The upper limit on controllable force is limited by the saturation force of 
the micro-actuator. 

Now allow the stiffness of the transmission between the actuators to increase. If the 
transmission stiffness is considerably lower than the environment stiffness then the micro- 
actuator closed loop performance (and stability and bandwidth) will be dominated by the 
stiffness of the environment. Consequently, the transmission can exert a force on the end- 
point which is summed with the force of the micro-actuator without affecting the dynamics 
of the micro-actuator. The macro-actuator can be used to impose a low frequency force 
bias on the endpoint, which will have little effect on the control performance (stability) 
of the micro-actuator. The result is that we can now exert forces near the maximum of 
the macro-actuator while controlling variations at the level of the micro-actuator. A hi-fi 
loudspeaker provides a metaphor for this concept; the two actuators are a woofer and a 
tweeter, coupled in parallel by a compliant transmission, air (Pratt, 1994). 

Several aspects of the design should be noted. First, the concept uses the "stiffer is 
better" paradigm to design the direct drive part of the system (the micro-actuator), but 
diverges from this principle for the macro-actuator. In fact the transmission between the 
two actuators must not be stiff for the concept to work. If the transmission were very stiff, 
the micro-actuator would "feel" the impedance presented by the macro-actuator and there 
would be no improvement in performance over the macro-actuator acting alone. Second, 
the concept allows the use of a lower performance actuator for the macro-actuator since 
its inertia and friction are "filtered" out by the transmission. Third, the concept allows 
a resolution bounded by the minimum controllable force of the micro-actuator and the 
maximum force of the macro- actuator. Micro-macro designs which are coupled in series can 
not achieve this kind of resolution; a series-coupled design is limited to the force range of 
the micro-actuator (until the actuator is at its position limit). 

The PaCMMA concept may be implemented in a variety of ways. Figure 2-1 suggests 
that the micro-actuator should be placed proximal to the end effector. However, another 
instantiation of the design could place the actuators together with the end effector at a 
remote location as shown in figure 2-2. As long as the end effector is coupled to the micro- 
actuator with the stiffest transmission possible and the macro-actuator is coupled with a 
compliant transmission, the concept is the same. In fact, the two actuators could be inside 
one housing, provided the transmissions meet our design constraints. 
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Figure 2-2: Alternative PaCMMA Configuration 
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Chapter 3 

Actuator Systems And 
Performance Metrics 



Evaluation of actuator technologies requires a careful look at the performance metrics avail- 
able to the designer. Typically, the designer has some idea what kind of position and force 
control bandwidth the system should achieve. While these metrics quantify performance in 
some tasks quite well, most applications have additional constraints that are imposed on 
the design. Sometimes the device must tolerate accidental impacts with the environment 
or fail gracefully if the control system fails. Other times accuracy and resolution drive the 
design. As task complexity increases so does the number of important performance criteria. 
For a general purpose manipulator, there are a multitude of criteria which must be traded 
against one another. 

This chapter defines the performance properties described in table 1.1. A quantitative 
method of measuring the properties is suggested whenever possible. 



3.1 Properties of the Actuators and Sensors 

Actuators and sensors are typically evaluated by the manufacturer across a large number 
of physical properties and performance specifications. In actuator systems the saturation 
force, inertia, and power ratings are commonly quoted while sensor systems are evaluated 
for resolution, linearity and accuracy. No attempt will be made to list all the component 
specifications which may be relevant. The most common specifications for actuator systems 
repeated below. 

3.1.1 Quasi-static Properties 

Quasi-static properties are those which can be measured while the system is in steady-state. 

Peak Force 

The peak force of an actuator is of obvious importance. Hayward proposes several peak 
force measures which are based on time intervals varying from 1 msec to continuous (a 
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smoke test) (Hayward and Astley, 1995). This is a useful distinction and measurement is 
straightforward. 

Static Friction Force 

Static friction force is the amount of force required to move the actuator when it is un- 
powered. This quantity should be specified at the output shaft if there is a reduction. 
Measurement may be accomplished by determining the force necessary to move the actua- 
tor from a resting position. 

Force Resolution 

The smallest measurable change in force is the force resolution. Most often, this is the 
resolution of a force sensing system where resolution is affected by sensor accuracy and 
noise as well as quantization noise if analog to digital conversion occurs. 

Position Resolution 

The smallest measurable change in position is the position resolution. In most cases, this is 
the resolution of a digital encoder, or the A/D resolution on an analog position sensor such 
as a linear potentiometer or resolver. 

3.1.2 Dynamic Properties 

Dynamic properties are those quantities which are measured when the system is moving. 
In mechanical components the inertia, damping, friction and backlash of the device are 
important. In electrical components slew rate, hysteresis and bias values are important. In 
actuator systems, the mechanical characteristics of inertia and acceleration dominate the 
system dynamics since they are typically slower than the electrical system. 

Inertia 

Inertia can be measured by applying known forces to the actuator and measuring the re- 
sulting acceleration. If friction is large, then the several trials must be run to determine the 
dynamic friction. 

Peak Acceleration 

Peak acceleration is the acceleration obtained when peak force is applied. Like peak force, 
a time interval should be specified. Measurement is straightforward. 

Dynamic Friction Force 

Dynamic friction force is the friction force applied to the actuator while moving. Measure- 
ment is most easily accomplished by applying a number of force transients to the device, 
recording the device acceleration and determining the net force applied to the actuator's 
moving element. Subtracting the net force from the total applied force yields the value of 
dynamic friction. 
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3.2 Properties of the Controlled System 

Examination of inertia, backlash, and peak force will provide some idea of the system per- 
formance. Yet these measures fail to capture many of the characteristics which designers 
know are important. Force bandwidth, position bandwidth, position resolution, force reso- 
lution and backdrivability are just a few of the performance specifications which need to be 
considered. These specifications are not purely a function of hardware selection; the con- 
trol system has a large influence on the performance as well. For example, certain control 
strategies may handle friction well but handle backlash poorly. Other control systems may 
not utilize the actuator's full power. For this reason it is imperative that actuator systems 
be evaluated with specific control laws. 



3.2.1 Quasi-static Properties 

As mentioned above, quasi-static properties are those properties which can measured while 
the system is in steady-state. 



Force Precision 

Force precision is the error in force when a steady state force is commanded. For example, 
a force error may exist and it may be measurable, but the chosen control law may not be 
able to eliminate it. This measurement should be expressed both as a percentage of full 
saturation and in units of force. 



Position Precision 

Position precision is the steady state position error. As with force precision, this quantity 
should be measured both as a percentage of the actuator system workspace and in units of 
position. 

Force Dynamic Range 

The ratio of the maximum controllable force to the minimum controllable force. Research 
on haptic displays suggests that the dynamic range of force plays an important role in 
creating a high fidelity display (Rosenberg and Adelstein, 1993). 

3.2.2 Dynamic Properties 

As mentioned above, dynamic properties of the controlled system are those quantities which 
are measured when the system is moving. These metrics are probably the most important 
in terms of overall system performance. Most of these metrics are frequency response mea- 
surements and can be performed using swept sinusoidal inputs. Additionally, most systems 
have saturation limits and the performance varies for small and large signal performance. 
Experiments should be specified for both small and large signals. 
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Position Response 

Position response is the frequency response of the system to a sinusoidal position command 
while in free space. More specifically, 






(3.1) 



F e =0 



where 

Xdes = the desired position 

X = the actual position 

F e = environmental force applied to the endpoint 

This is a relatively common performance specification. The bandwidth is easily defined 
as the frequency at which the response function, H pos , is attenuated by 3 decibels 

Force Control Response 

Force control bandwidth is the response of the system to sinusoidal force command with 
the endpoint stationary. Figure 3-1 



out 



des 




► CD 



t 



1 out 

Figure 3-1: Force Control Response. Force control response is a frequency response 
measurement which is obtained with a fixed endpoint. The 3db point may be used to define 
force bandwidth. 



Mathematically, this test is described as follows: 

FJu) 



H ic {u) 



Fdes(u) 



(3.2) 



x e =o 



where 

F de 



the desired force 
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F e = the force exerted on the environment 

X e = the position of the end effector 

This specification comes from the desire to quantify a robot's performance in quasi- 
static applications like slow manipulation or the control of a slipping object. In this case, 
the ability to modulate forces applied to a relatively motionless environment is of premium 
importance. Force control bandwidth, ujf c , may be defined as the 3db point of the magnitude 
response of Hf c (uj). 

Impedance 

Actuator impedance is extremely important when the robot and the environment it con- 
tacts are in motion. Designers refer to "backdrivability" and "compliance" to describe the 
relationship between force and displacement of the actuator. In tasks such as surface fol- 
lowing or dynamic contact sensing the actuator may be required to maintain constant force 
in the presence of small disturbances, whether the disturbances are due to small changes in 
position or unmodelled contact forces. In pure force control an ideal actuator would present 
zero impedance across all frequencies; in real systems this quantity should be as small as 
possible. 

Impedance Response: The frequency response (transfer function) of the system to 
a position disturbance at the endpoint, i.e. the endpoint is connected to a position source 
while the desired force is commanded to be constant: 



Z(u) 



" error \^ ) 



F(i es =constant 



where 

" error — " des " e 

Xi n = the position disturbance 

Impedance is best thought of as the forces that result from a position disturbance. An 
performed an experiment in which a robot link was placed on a moving cam, and given 
constant force command (An, 1986). Figure 3-2 depicts this experiment. 

Distortion & Signal Fidelity 

Distortion is an important, but often overlooked specification in robot actuator design. 
As interest in haptic interfaces has grown, it has become clear that human perception 
of distortion is quite good and that distortion of force signals in haptic display systems 
is undesirable. Figure 3-3 shows several force signals with varying degrees of distortion. 
The variation from a true sinusoidal signal may be measured in the least squares sense by 
computing the RMS error from a best fit sinusoid at the excitation frequency, uj: 

Given a sequence of samples, T, a sinusoidal curve of frequency uj may be fit to the data 
using the equation: 

RA = T 
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error 
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(0 



Figure 3-2: Impedance Response. Impedance response is a frequency response measure- 
ment which is obtained by commanding constant force and measuring the force error which 
results as the endpoint is moved. Impedance bandwidth may defined as the frequency where 
the force error begins to increase with frequency. 



where 



T = sampled signal 
R = [sin(wf) cos(urf)] 
A = [ Cl c 2 ] T 

Solving the equation for the least squares minimum error, 

A = (R T R)- 1 R T T 
Using the best fit signal, RA, a normalized measure of signal fidelity is: 



Signal Fidelity 



T T RA 



or 



Signal Fidelity 



T T R(R T R)- 1 R T T 

Wr 
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Figure 3-3: Distortion Example. These three graphs show examples of distorted signals. 
The values of Signal Fidelity for these graphs are 0.99, 0.86, and 0.74. Distortion is 1%, 
14%, and 26% respectively. 



The value of this matrix expression is 1.0 for a perfect sinusoid. A value of 0.99 represents 
1.0% distortion. 



Force Control Performance Space 



All actuator systems have amplitude and frequency limitations. The performance of actua- 
tors can be visualized in a region I will call "Performance Space" . The performance space is 
two dimensional with axes of frequency and amplitude much like a frequency response plot. 
Within this space there are regions where an actuator may operate with acceptable perfor- 
mance and there are regions where the performance is unacceptable. Figure 3-4 (left figure) 
shows an example of a typical force control performance space for an actuator. In this case, 
the shaded region represents values of amplitude and frequency where the actuator error is 
less than 10%. 

Some actuators have the ability to exert large forces at lower frequencies, while other 
actuators have the ability to exert smaller forces at higher frequencies. Figure 3-4 (right 
figure) shows the theoretical operating regions of a micro and macro-actuator indepen- 
dently. The macro-actuator can attain a large force amplitude but is limited to relatively 
low frequencies while the micro-actuator can produce a smaller amplitude but at higher 
frequencies. 



34 



CHAPTER 3. ACTUATOR SYSTEMS AND PERFORMANCE METRICS 




□ Error < 10% 




[XI Macro 
\Z\ Micro 



CO 



CO 



Figure 3-4: Force Control Performance Space. The regions are bounded by curves of 
constant error. 



Controllable Impedances & Impedance Performance Space 

The main reason to use force controlled actuators is to exploit the programmability of the 
device. Each actuator will have a range of impedances which it can accurately emulate. 
Pratt and Williamson have presented a useful method of displaying the impedances an 
actuator can emulate (Williamson, 1995; Pratt and Williamson, 1995). Much like the force 
performance space, this is an impedance performance space. Figure 3-5 illustrates this idea. 
The bounded region can be increased by increasing saturation torques, increasing sensor 
resolution and modifying the passive properties of the system (mass, stiffness, damping). For 
example, increasing saturation torque will allow the device to emulate a stiffer impedance 
whereas reducing the position resolution (less accurate) will reduce the stiffness that may 
be emulated. 



Error <10% 




► Re(Z) 



Figure 3-5: Impedance Performance Space. The actuator is programmed to create a 
desired impedance, Z(u>) = Ms 2 + Bs + K and the impedance response at each frequency 
is plotted in the complex plane using s = juj. If the actuator can produce the desired 
impedance with less than 10% error, then the impedance is contained in the shaded region; 
the region is bounded by a curve of constant error. 
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The manipulator impedance may be represented by a point in complex space. The users 
would like to be able to change the operating point and obtain a predictable impedance. 
However, non-ideal effects limit the operating region. Many parameters affect the location 
of the region in the complex plane: Saturation, inertia, sensor resolution, friction, backlash 
to name a few. To further complicate matters, the operating region for small displacement 
disturbances is not the same as the operating space for large displacements. To fully quantify 
performance, the operating region should be a three-dimensional solid, with disturbance 
amplitude as the third dimension. 
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Chapter 4 

System Model and Performance 
Limits 



All actuator systems have performance limitations that are based on saturation forces. The 
purpose of this chapter is to determine the maximum possible performance of the parallel 
coupled micro-macro actuator system operating at saturation. These results will be useful 
to the designer for determining best case system performance as well as providing a useful 
benchmark for evaluating control law performance. Much of the analysis presented here 
may be applied to any actuator design and would be useful in the comparison of various 
actuator systems. 

4.1 Actuator Model 

The actuator model will rely on several linear and nonlinear parameters and will be used to 
estimate some limits on performance. The actuator concept can be modeled using lumped 
elements as shown in figure 4.1. The dynamics are described by two equations: 




Figure 4-1: Parallel Coupled Micro-Macro Actuator Model 



Mix\ = F x + F t (x 1 - x 2 , x\ - x 2 ) - F e 



(4.1) 
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M 2 x 2 = F 2 - F t (x 1 - x 2 , x\ - x 2 ) (4.2) 

In general the input forces, F\ and F 2 , are bounded at the upper limits by some finite 
response time and some finite magnitude. For electric motors these limits are imposed by the 
electrical time constant and the motor's maximum power dissipation. In a hydraulic system 
these limits are imposed by the speed of the servo valve and the maximum fluid pressure 
and piston area of the actuator. In addition to these actuator limits, there is a bandwidth 
limit on force measurement. It is assumed that the force measurement bandwidth is much 
higher than the response bandwidth of the actuators and does not need to be included in 
the dynamic model. 

In order to keep the model concise, the dynamics of the force sensor and the micro- 
actuator (Fi,Mi) will be lumped into a single function, H\ol{s)- The function, H\ol{s), 
can be viewed as the combined open-loop force response of the force transducer and micro- 
actuator. Any micro-actuator can be controlled to have a well damped open loop response, 
Hiol(s), with bandwidth, lo\ol without any loss of generality. This can be implemented 
in most systems by pre-filtering the input signal at a frequency below the first natural res- 
onance of the system. As was pointed out by (Eppinger, 1988), control systems will have 
great difficulty trying to operate above the first natural resonance. To incorporate these 
facts in the model, I will introduce a low-pass function to limit the speed of response of the 
micro-actuator and two saturation parameters: 

Hiol(s), the open loop micro actuator response 
Fisat, the saturation force of the micro-actuator 
F 2sa ti the saturation force of the macro-actuator 

The macro-actuator also has limited bandwidth, H 2 ol{s)- However, the bandwidth of 
F 2 will be effectively filtered by M 2 and the transmission, so H 2 ol{s) will be left out of the 
model. 

The transmission dynamics are represented by the general function F t {x,x) which can 
be modeled more specifically as a spring and damper for most transmissions: 

F t (x, x) = —K t x — B t x (4-3) 

In this case, the equations become: 

M x x\ = F 1 H 10L {u) ~ Kt(xi - x 2 ) - B t (x\ - x 2 ) - F e (4.4) 

M 2 £ 2 = F 2 + K t { Xl - x 2 ) + B t (x\ - x 2 ) (4.5) 

The environment force, F e , can take on a number of values. In the case of an actuator 
in free space this may be an external force such as gravity or transmission friction acting on 
the load. In the case of manipulation this force may represent an environmental impedance 
(stiffness). Since the primary application for this actuator is manipulation, I will use a 
simple representation for the environmental force: 
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F e = K e Xi (4.6) 

The value of the environmental stiffness, K e , may be varied to model a wide variety of 
manipulation conditions. When the actuator is in contact with a very stiff environment, 
the contact dynamics are well modeled using this representation. In the case of free space 
motion the stiffness may be set to zero. This representation is also undamped. This has the 
benefit of being a "worst-case" environment. Undamped, stiff environments are among the 
most challenging of operating conditions because the slightest misuse of actuator energy will 
excite the environmental resonance. Further, the stiff environment makes active damping 
(through velocity measurement) difficult since the displacements are small. 

Equations 4.4 and 4.5 represent the dynamics of the system with the two inputs. The 
transfer function formulation yields the following equation: 

(M 2 s 2 + B t s + K)F 1 H 10 l(s) , (Kt + B t s)F 2 ,. _. 

Xl(s) - W) — W) — ( } 

where 

A(s) = (M lS 2 + B t s + K t + K e )(M 2 s 2 + B t s + K t ) - (K t + B t sf 
and when K e = 0, 

A(s) = s 2 (M 1 M 2 s 2 + B t {M 1 + M 2 )s + K t {M 1 + M 2 )) 
This is a linear, fourth order system and we can examine the effect of each input indepen- 
dently. Insight may be gained from frequency response analysis of the system. 



4.2 Frequency Response 

The frequency response of the PaCMMA system is presented for both inputs and several 
operating cases to illustrate how the dynamics change with various environmental conditions 
(figures 4-2, 4-3, 4-4). The simulation values are listed in Appendix B. The output is taken 
to be the position of the endpoint, x\, and consequently, the output magnitude will vary 
with the stiffness. A designer typically increases the transmission stiffness and decreases 
the mass of the endpoint so as to shift the first natural resonance to the largest possible 
value. 

Examination of these figures will make several things clear. First, the dynamics of the 
system in free space are very different from the dynamics of the system in contact with 
the environment. In free space, the system is an integrator and the gain increases as the 
frequency decreases whereas the system in contact with the environment has constant gain 
at low frequencies. For this reason, control laws which work well in free space may not 
work well when the system is in contact with an environment; force feedback literature has 
shown that instability is a problem for stiff environments (section 1.2.2). 

Consider only the first input, F\. When the system is in free space, the phase portion 
of the plot reveals that the system lags the input by 180 degrees. To create a stable closed 
loop system, the bode phase-gain theorem requires that the phase lag be less than 180 
degrees at unity gain. For the free-space system, this requires the introduction of phase 
lead (derivative gain). 

When the system is in contact with a spring-like environment, the dynamics are quite 
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Figure 4-2: Frequency Response in free space. F \(l i F2(s) wnere -^"l i s the displacement 
of the endpoint, F\ is the force command to the micro- actuator and Fi is the force command 
to the macro-actuator. 



different. In this case, the system has a large amount of phase margin and the loop gain 
may be increased dramatically with the addition of pure integral gain. The 90 degree lag 
introduced by integral gain is relatively unimportant since the system shows zero lag up to 
its resonant frequency. Further, when the environment is stiff addition of phase lead from 
a position derivative is quite difficult since the position changes are small. The dynamics 
of the actuator will be discussed again when the control law for the actuator is described. 

In the following sections, the performance of the actuator will be evaluated under several 
performance metrics. 



4.2. FREQUENCY RESPONSE 



41 




10 
Frequency, Hz 

Figure 4-3: Frequency Response with a soft environment. pj}f[ , p2( s ) where X\ is 
the displacement of the endpoint, F\ is the force command to the micro-actuator and Fi is 
the force command to the macro-actuator. 
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Figure 4-4: Frequency Response with a stiff environment, ^(^^(si where X\ is 
the displacement of the endpoint, F\ is the force command to the micro-actuator and Fi is 
the force command to the macro-actuator. 
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4.3 Position Control Performance 

This section addresses the performance limits of the PaCMMA model while in free space. 
When the actuator is in free-space (i.e. K e = 0), the system position may be commanded 
to follow a position trajectory. Force saturation of the actuator limits the maximum ac- 
celeration and therefore, the bandwidth of the system. If perfect knowledge of the past 
and future inputs is assumed an estimate of the best case performance of the actuator can 
be easily determined. (The following analysis may be used on any dynamic system with 
saturation limits.) 

Consider the case where a sinusoidal trajectory is desired. The actuator may operate 
in two regions. The first region is where the desired output may be achieved without 
saturating the actuators. In the second region, the actuator can not achieve the desired 
output because the actuators have saturated. The boundary of these two regions is the 
operating point where both actuators have saturated, and the desired trajectory is being 
achieved. At this point, the two actuator inputs are: 



and 



Substituting into equation 4.7, 



Fi = F lsat sm(ujt) 



F 2 = F 2sat s'm(ijt + (j>) 



= (M2 ' 2 + f tS + R } H 10L (s) C {F lsat sin(^)l (4-8) 

A(s) 



A( S ) 

where 

A(s) = s 2 (M 1 M 2 s 2 + B t (M 1 + M 2 )s + K t (M 1 + M 2 )) 
and 

L is the Laplace Transform. 

In order to maximize X\, 4> must be chosen with the appropriate phase such that the 
vector contributions from F\ and F 2 are in the same direction: 

B t u \ , _i ( B t u 



-i / B t uj \ 

d> = tan — — — - — tan 

\K t -M 2 uj 2 ) 



Kt 



(4.10) 



When this occurs, the magnitude of X\ may be shown to be: 



(K t - M 2 u*)* + (By) 2 ) p , (A? + (B t u:f) 
X 1 {u) = J ^r- F lsat + J — F 2sat (4.11) 
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Figure 4-5: Maximum Position Response. This figure shows the position response if 
both actuators are saturated and their forces are summing constructively. It provides an 
upper bound on the achievable position bandwidth. 



This equation represents the relationship between amplitude of displacement and fre- 
quency of excitation. It is a theoretical limit on the maximum achievable displacement 
at a given frequency. (Note that the magnitude axis has units of displacement, unlike a 
typical frequency response magnitude plot where units are dimensionless and expressed in 
decibels.) In practice, few systems ever operate at this limit due to unmodelled dynamics 
and control law implementation issues. A system operating in this region will not respond 
to corrective measures and is typically in danger of becoming uncontrollable. While actua- 
tors may saturate under various operating conditions, the actual system frequency response 
must lie on or below the line described by the equation above. 



4.4 Force Control Performance 



Force control response is a measure of the system response to both changes in the desired 
force and force disturbances. Chapter 3 introduced this definition, and it is repeated here: 



H 



fc 



U) 



F e (u) 

Fdesiu) 



(4.12) 



x e =o 



where 

Fdes = the desired force 

F e = the force exerted on the environment 

X e = the position of the end effector 

Using the argument of the previous section we can determine the maximum possible 
force control response. The operating point where the output force is maximized is: 
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F\ = F Uat sm(ut) 
and 

F 2 = F 2sat sm(ut + 4>) 

The assumption of perfect control means that for a desired amplitude, we can select (f> 
so that there is no phase difference in the contribution from each actuator and the applied 
force will be maximized. For this case, the force output in the frequency domain is: 

F e (s) = F lsat H 10 L(s) + „, * ,, 9 F 2 . sa t 

F t (s) + M 2 s 2 

Using a traditional spring/damper model for the transmission (Ft(s) / AX (s) = B t s + 
K t ), this function becomes: 

F des {s) = F lsat H 10L (s) + » /"t ^ ^ 4 - 13 ) 

The second term in equation 4.13 is readily recognized as forced harmonic vibration 
where M 2 is being driven by F 2 . Figure 4-6 shows how the two inputs are summed to 
determine the maximum amplitude of the system output. The function may be inverted to 
determine the maximum achievable amplitude at a given frequency, i.e. when the actuator 
is driven to saturation in order to meet the desired trajectory. As an example, if the desired 
torque is l.OmNm, then the maximum frequency is easily determined through graphical 
means to be 3.92Hz. This equation represents a relationship between desired amplitude 
and maximum operating frequency and represents a fundamental hardware limit of the 
system. 



4.5 Impedance Performance 

Impedance performance of the PaCMMA will be one of its most important characteristics. 
The low mass of the micro-actuator and the compliant transmission will produce much 
lower impedance at the same bias forces than could be achieved with the macro-actuator 
alone. Impedance performance was defined in Chapter 3 and is repeated below. 



ry/ \ ^ error [^ ) 

Ziuj) 



XiJco) 



F(i es =constant 



In the case of impedance response, perfect control is taken to be the control strategy 
which maximizes the apparent admittance and minimizes the impedance of the PaCMMA. 
This is equivalent to maximizing x\. Using equations 4.1 and 4.2 we can derive an expression 
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Figure 4-6: Maximum Force vs. Frequency. The top graph shows the micro and macro- 
actuator responses independently while the bottom graph shows the PaCMMA response. 
The PaCMMA response is the sum of the two responses due to the parallel arrangement. 



for x\ which contains three driving terms (Fi,F 2 , F e ): 



XAs) 



{F^HwLJs) - F e (s))(M 2 s 2 + B t s + K t ) + F 2 (s)(B t s + K t 
s 2 {M 2 M lS 2 + B t (M 1 + M 2 )s + K t (M 1 + M 2 )) 



(4.14) 



For the purposes of a frequency response analysis, we can take F e (t)=Asm(ujt). In order 
to maximize the amplitude of Xi(s), the contributions from F\ and F 2 should be given the 
necessary phase to add to the response from F e (t). X\(s) is maximized when: 



and 



F 1 (t) = -^± S in(ut) 
n\OL 



F 2 (t) = -F 2sat sm(ijt + 4) 



(4.15) 



(4.16) 



This case is similar to the case of pure position control, except that the environment force, 
F e , appears in the equation. The admittance of the PaCMMA can now be written: 



F P 



Flsat 



HioUf) - l)(M 2 s 2 + B t s + Kt) 
A(s) 
^(B t s + K t )(cos((f)) + sin(^)s) 

" Ms) 



(4.17) 
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Figure 4-7: Minimum Impedance vs. Frequency. The impedance response, 
F e (s)/Xi(s), is dependent on the magnitude of the disturbance force, F e . 



Equation 4.17 is very similar to the system response in position control and the impedance 
response of the system is roughly the reciprocal of the position response. This is not surpris- 
ing since the actuator must move its endpoint mass in both cases. Secondly, the minimum 
achievable impedance is dependent on the magnitude of F e . Finally, it is important to 
remember that this expression represents the best possible performance, under perfect con- 
trol. In general, we do not have full knowledge of the disturbance input, F e and as a result, 
the minimum achievable impedance will be considerably higher. Figure 4-7 shows a typical 
plot for the actuator impedance, F e (s)/X\(s). 

Careful analysis of the transfer functions in the preceding section suggests that with per- 
fect control, lower impedance and higher position control bandwidth may be achieved with 
a stiffer transmission. However, the control law has limited bandwidth and the dynamics 
of the undriven system will dominate the system at frequencies above that bandwidth. In 
manipulation, collisions are part of normal interaction and impacts typically contain high 
frequencies. In these cases, low impedance can only be achieved through passive methods 
such as a low inertia and a soft transmission. This issue will be discussed in greater detail 
in section 4.7 



4.6 Force Step Response 

Time domain performance is another important benchmark for the actuator system. In 
manipulation tasks time domain specifications are a useful way to evaluate the system's 
response to sudden changes in the desired force and position. 

Force step response will be computed under the same conditions as force control response 
in the section above, i.e. a fixed endpoint. Further, it is assumed that the micro-actuator 



4.6. FORCE STEP RESPONSE 



47 





X t 2 t; 






■"2sat 










F, 




'des 








2 




■F, , 














1 2sat 








Msat 






< 


F x 












■"des 










F 








1 e 




■"last 





























Figure 4-8: Control strategy for a step change in force 



force, F\, responds much more quickly than the force imposed by the macro-actuator, 
KfAx + B t Ax. For a step input in desired force, the fastest possible response is achieved by 
applying full saturation force to both actuators, then reversing F 2 at t\ and finally stopping 
both masses at the desired force (position) at i 2 . In the final resting position, F\ should be 
zero to ensure that the response to random transients will be as fast as possible. Figure 4-8 
presents these events graphically. 

The minimum settling time for F e is determined by t 2 . Equation 4.5 may be solved 
directly for x 2 (t). On the interval [0, ti], 



x 2 (t) 



F2sat /-. e 

K i \ 



-(w n t 



yr^c 



:S1H 



\Ji - ( 2 u n t + <j> 



where 

c = 



B t 



2y/K t M 2 

u n = y/Kt/M 2 



<f> = tan" 



-i iVEl 



c 



On the interval [£i,£/], 



r^"^ {x 2 ( tl ) + ^*) COS (yjn?(j n (t - t X ) 

x 2 (h)+ (%f + X 2 (hj) Cu n _ 



Tw 2 



UJ„ 



mnUl-C 2 Mi-h))) 
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Figure 4-9: System Step Response - Perfect Control. ( = 0.25 for damped case 



These two equations can be solved numerically for t\ and tf using the boundary condi- 
tions. Finally, the equation for t 2 may be solved: 



F de 



Flsat + K t x 2 {t 2 ) + B t x 2 {t 2 ) 



Figure 4-9 shows the response of the system to this strategy. It is important to remember 
that this solution gives the minimum settling time solution. The applied force, K t x 2 + B t x 2 , 
will exceed F^es if the transmission damping, B t , is nonzero. Another interesting feature of 
this simulation are the discontinuities in the applied force. These small discontinuities reflect 
the response of the micro-actuator. Consider the case of the damped transmission, when 
the applied force is sufficiently close (within F\ sat of the desired force) the micro-actuator 
can cancel the error. With the use of optimal control techniques (dynamic programming), 
equation 4.5 may be solved with additional constraints such as a requirement that the 
applied force not exceed some fraction of the desired force: (1 + a)Fd es > {Ktx 2 + B t x 2 ). 



4.7 Impacts 

In many applications, a manipulator moves from free space into contact with the environ- 
ment and an impact results. Sometimes the collision occurs because there are unexpected 
errors in the position of the manipulator or the environment. Other times the collision is 
part of a deliberate manipulation movement. In both cases, it is useful to determine the 
effects of the impact on the environment and the actuator. 

Consider the case of a manipulator moving in free space which suddenly detects a colli- 
sion, as shown in figure 4-10. Perfect control in this case requires that both actuators are 
turned on to full saturation force in order to reverse the collision as soon as the collision is 
detected. A discussion of the dynamics follows. 

The conditions are tabulated in table 4.1. At t = 0, the collision occurs and energy 
is transmitted to the environment. At t = t\, the collision is detected and the actuator 
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Figure 4-10: Impact - Perfect Control 



torques, F\,F 2 are set to full saturation. At t = i 2 , the displacement of the transmission 
reaches its maximum and the contact force begins to decrease. After this point in time, 
higher level control determines whether the manipulator should maintain or break contact 
with the environment. 

Two quantities are of interest during the collision. The first is the energy dissipated 
when Mi hits the environment and the second is the maximum force transmitted by the 
transmission to the environment. In the case where the collision is inelastic the energy 
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Table 4.1: Impact Dynamics 
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transmitted to the environment is: 

M 1 M e V* 
AE = , , * -2- (4.18) 

Mi + M e 2 y } 

If the transmission damping B t is large, then the transmission is effectively rigid dur- 
ing impact and nearly all the kinetic energy of the macro-actuator is transmitted to the 
environment. This is generally undesirable and therefore, the transmission should not be 
heavily damped if impacts are likely. 

After the collision but before detection, the displacement of the macro-actuator is de- 
scribed by: 



-„* Vo 1 



x 2 (t) = e -^-l-_= s in ( \/l - C 2 u n t ) (4.19) 



■1 



(t) = e-^"V sin ( ;/l - CW + 4> ) (4.20) 



where 



<f> = tan-i (^) 

If B t is assumed to be small the force exerted on the environment by the macro-actuator is 
given by: 




F m acro = K t x 2 = ^/ K t M 2 V sm h/Tr* ( 4 - 21 



Equation 4.21 highlights several issues. If the transmission stiffness, K t , is large then 
two bad things happen. First, F macro becomes large because the force changes rapidly as 
x 2 — x\ changes. Secondly, the detection time, t\ becomes large compared to the natural 
frequency of the system, \lj^, and the sine function reaches its maximum value (1.0) 
thereby increasing F macro . Reducing the transmission stiffness decreases the rate of force 
application by the macro-actuator. Since all systems have finite response time, transmission 
compliance can be effective in reducing the force applied during impact. 

In the general case, the maximum contact force may be determined by solving a series 
of equations. The general equations and solution method are presented below. 

Computing the Laplace transforms on each state yields: 



XUs) 



(K t + B t s)X 2 (s) + U^s) + JCi(s) 



IC\(s) = (M 1 + M e )x 1 (0+) + ((M 1 + M e )s + B t + B e )x 1 (0+)-B t x 2 (0+) 
Ai(s) = (M 1 +M e )s 2 + (5 t + 5 e )s + ii' t + ii' e (4.22) 



X 2 (s) 



{K t + B t s)X 1 {s) + U 2 (s) + IC 2 (s) 
A 2 (*) 
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A 2 (s) = M 2 s 2 +B t s + K t (4.23) 



(Kt 


+ B ti 


s)(U 2 (s) + IC 2 (s) 


) + A 2 (s)(U 1 


(s) + IC 1 (s)) 


(Kt 


+ B ti 


A 1 (s)A 2 (s) - (K t + B t sf 
5 )(^i(s) + ICris)) + A 1 ( S )(U 2 


(s) + IC 2 (s)) 



IC 2 (s) = M 2 i 2 (0+) + (M 2 s + B t )x 2 (0 + ) - B tXl (0+ 
A 2 (s) = 

Solving for each state gives: 

X 1 ( S ) 

X2(S) ~ A 1 (s)A 2 (s)-(K t + B t sy 

(4.24) 

On the interval i=[0 + , ^i] the initial conditions and inputs in table 4.1 may be substituted 
to get: 

y ,, (M e + M 1 )f 1 (0+)A 2 (.) + (K t + B t s)M 2 V 
1{) ~ A^A^-dU + Btsf {A - Zb) 



YU s M 2 V A 1 (s) + (K t + B t .s)(M 1 + M e )f x (0+) 

MS) = A l(s )A 2 ( S )-(^ + 5 tS ) 2 (4 - 26) 

Inversion of the two equations using the inverse Laplace Transform will yield a time- 
domain solution to the system dynamics and the values of xi(ti), x\(ti), x 2 (t\), and af 2 (^i) 
may be determined on the interval i=[0 + ,£i]. At t = t\, the system equations must be 
solved using x\(ti), x\(ti), x 2 (t\), and af 2 (^i) as initial conditions and non-zero inputs. 



X[(s) 



(K t + B t s){-F 2sat + M 2 x 2 (h) + (M 2 s + B t )x 2 (h) - Btx^h)) 

A 1 ( S )A 2 ( S )-(ii' t + 5 tS ) 2 
A 2 (,s)(-F lsat + (Mi + M e )Ai(fi) + ((Mi + M e )s + B t + ^ e )a;i(fi) - B t x 2 (h)) 

Ai(s)A 2 (s) - (K t + B t sf 



The expression for sX[(s) may be inverted to determine the velocity as a function of 
time. Setting the velocity equal to zero and solving for time will give the value of t 2 — t\. 
The value of t 2 — t\ may then be used to determine the force on the environment by direct 
substitution into the expression F max = K e x' 1 (t 2 — t\) + B e x\'(t 2 — t\). 

Several conclusions may be drawn from this model. First, it is clear from equation 4.18 
that reduction of the endpoint mass of the actuator, Mi, and the approach velocity, V , 
will minimize the energy delivered to the environment when contact occurs. This result 
is independent of any control strategy or actuator limit and represents very real physical 
limit on performance. Second, equation 4.21 shows that reducing Kt, the transmission 
stiffness, M 2 , the macro-actuator mass, and t\, the time it takes to detect a collision, will 
reduce the impact energy and contact force resulting from the macro- actuator. In effect, 
the transmission shields the environment from the mass of the macro-actuator by using 
the spring to store energy rather than dissipating the energy in a collision and by using 
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a soft transmission to decrease the rate of force increase once contact occurs. Decreasing 
the rate of force rise allows more time for the controller and actuator force to decelerate 
M^. It should be noted that this analysis may be applied to any manipulator impact, not 
just the PaCMMA. This analysis shows that a traditional stiff manipulator will transmit 
more energy to the environment on contact and will generate greater contact forces than a 
compliant manipulator. 



4.8 Causal Control 

The control relations derived in the previous section assume an unrealistic amount of in- 
formation - they assume that the desired force and any disturbances are known for both 
the past and future. A more reasonable approach assumes that one has some amount of 
knowledge about the current state and perhaps some past state history upon which to base 
the current control efforts. Under these assumptions, the system bandwidth will be lower. 
Nonetheless, the metrics provided above may be used to determine upper bounds on sys- 
tem performance. When the control law is developed in Chapter 5, these metrics will prove 
useful for evaluating the control system performance. 

4.9 Consideration of Nonlinearities 

In addition to force saturation, the PaCMMA system contains several other nonlinearities. 
Some of these nonlinearities may be avoided using different system configurations while 
others are present in all configurations. The analyses above do not specifically address 
these nonlinearities but some comments are presented below. 

4.9.1 Stiction 

With a brushed motor, stiction from motor brushes and bearings at the endpoint can 
produce a limit cycle at some minimal force level (Townsend, 1988). Even the best control 
law for F\ will produce some small force error. Townsend quantified this error and showed 
that it is best to minimize any system friction between the actuator and the endpoint. 

Stiction which occurs in the macro-actuator is filtered out by the transmission because 
small changes in position (limit cycles) are passed through the transmission as extremely 
small changes in force. As long as the damping in the transmission is minimal, then the 
stiction limit cycle will not have a significant effect on the endpoint force. This is one 
outstanding benefit of using a compliant transmission. 

4.9.2 Velocity Saturation 

Velocity saturation may occur independently of force saturation, especially in systems which 
employ large reductions on the macro-actuator or low voltage power supplies. Velocity 
saturation in the micro actuator is unlikely since manipulation speeds are typically low. 
In most cases velocity saturation may be avoided in the macro actuator by using a more 
forceful actuator with a smaller reduction (lower torque density) 
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4.9.3 Position Saturation 

The model presented above assumes that neither actuator has limits on position displace- 
ment. This is generally a valid assumption for electric motors and other rotary actuators. 
Some actuators have limited displacement capability (voice coils, hydraulic cylinders) and 
this limitation may present a significant constraint on the performance of the system. Since 
the actuators act in parallel, both actuators must be capable of traveling the full displace- 
ment range. This is distinctly different from the serial micro- macro configuration in which 
the micro-actuator needn't have the full position range of the system. 

4.9.4 Backlash 

Because backlash can introduce harmonic frequencies above the driving frequency, a macro- 
actuator with backlash can introduce force disturbances above the controllable frequencies 
of both the macro and micro-actuators. This can happen any time the gearhead is unloaded 
which occurs when the transmission deflection is small or when the position changes in the 
macro- actuator position are very fast. Precise force generation is the main purpose of this 
design and backlash can defeat this purpose. 

4.9.5 Transmission Dynamics 

The transmission model used in this analysis is massless (i.e. K t and B t ). A real transmis- 
sion has mass and dynamics which may or may not affect the performance of the system. 
For example, a transmission which has high frequency resonances may produce disturbances 
above the controllable frequency of the micro-actuator. In this situation several actions may 
be taken. First, the transmission may be redesigned to have lower frequency dynamics via 
the addition of mass or damping. Second, the control algorithm may be modified to avoid 
exciting the transmission resonance. 

4.10 Summary 

The performance limits derived in this chapter provide guidance for the designer as well 
as highlighting the design advantages of the PaCMMA concept. The reduced mass of the 
micro-actuator, Mi, and the intentional use of compliance in the transmission result in 
lower impact forces than could be achieved with the macro-actuator alone using a stiff 
transmission. The micro- actuator can produce high force control bandwidth up to it's 
saturation torque. The position bandwidth of the device is limited by the acceleration 
values of the actuators, F\jM\ and FijMi- 
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Chapter 5 

Control System 



In manipulation, a wide range of dynamic events may occur. Users of robotic manipulators 
or other dynamic machines would generally like the devices to be able to follow positions ac- 
curately in free space, to make contact with objects in the environment in a non-destructive 
manner, and to be able to maintain contact with a wide variety of environments. During 
these operations, particularly contact, the user typically wants motions to be smooth, sta- 
ble and predictable. The PaCMMA concept performs these tasks well while using a single 
control system. This chapter addresses some of the control issues of the parallel coupled 
micro-macro actuator system. 



5.1 Control Issues 

As mentioned in Chapter 1, control of manipulation forces against stiff environments is very 
difficult when the actuator and sensor are not collocated. The achievable control bandwidth 
is limited by the structural bandwidth of the transmission (Eppinger, 1988). For this reason, 
transmissions are typically made quite stiff. However, most transmissions are insufficiently 
damped and adding damping to the transmission is hard to accomplish computationally 
since derivatives are difficult to calculate with very small displacements. Typical position 
encoders impose significant limits on velocity computation in this case. 

A second issue is the control of the transition from free space to contact with the environ- 
ment. The robot may be damaged as a result of the energy dissipated during the collision. 
As shown in section 4.7, reducing the mass and the approach velocity help prevent this. 
Second, the control law may become unstable when the actuator contacts the environment 
due to the change in dynamics. As mentioned in section 1.2.2, control of impacts and 
contact transitions has typically involved switching control algorithms. 

The ability to continuously modify the system impedance is the primary benefit that 
force control actuators offer over a position controlled actuator with passive elements on 
the endpoint. An ideal actuator would allow the user to continuously adjust the impedance 
of the system so that the system could be stiff when contacts were unlikely, softer when an 
impact is expected and perhaps stiffer again when contact has been established. The ideal 
system would remain stable in all environments despite these changes. Colgate introduces 
the requirement of "passivity" and proposes several techniques for designing a control system 
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Figure 5-1: Control Strategy 



which is guaranteed to be passive (Colgate and Hogan, 1989). 

A number of best-case operating conditions were discussed in chapter 4. In those cases 
it was assumed that the actuators produced the commanded force and that all model pa- 
rameters were well known. In reality there are modeling errors, parameter uncertainties 
and unmeasured quantities which require feedback of errors in addition to the feedforward 
control described in chapter 4. 

The primary quantity of interest in this control system is force. Hogan argues that 
manipulators should present an impedance which implies that the system should accept 
position inputs and output force (Hogan, 1985). Thus a system which can accurately 
produce the desired force over a large range of frequencies, can be programmed to produce 
the appropriate impedance for a given task. In addition to accurate force generation the 
system must be stable in a wide range of configurations. The goal of the control algorithm 
is to modulate the applied force in the presence of disturbance forces and endpoint motion. 
Since there are two control inputs (Fi and i^) and one output (F e ), the question arises: 
What is the appropriate strategy for dividing the control efforts in order to best control the 
output? Figure 5-1 shows the basic control structure. 

One approach is to formulate the problem as a Linear Quadratic Control problem. In 
this technique a cost function is created which weights the control efforts and states to 
obtain an optimal gain strategy. A cost function for the PaCMMA might apply some 
penalty to the control efforts of the two actuators, a penalty on the force error and perhaps 
some penalty on the energy dissipated or stored by the transmission in order to make sure 
the actuators are not working against each other. 

There are several drawbacks to this approach. First, saturation is only accounted for by 
modifying the control costs to prevent saturation from occuring. Ultimately, the designer 
avoids saturation by tuning the coefficients in the cost function. The LQ representation is 
particularly useful when the measurements, states, and cost functions are related to each 
other in a nonintuitive way. When the quantities of interest and the effects of the inputs 
are both easily observed, the LQ representation offers increased complexity without greater 
insight. Another limitation is that the gain matrix produced by LQ control may not yield 
insight into how to modify the system to obtain better performance nor will LQ control 
generate a control law which adds an integrator or uses a nonlinear strategy. Finally, a 
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Figure 5-2: Forces Acting on the Endpoint 



fourth order system requires solving ten simultaneous quadratic equations. This approach 
will be used once numerical values have been assigned to the various parameters, but this 
approach will not produce a symbolic solution for systems greater than second or third 
order. 



5.2 PaCMMA Control Strategy 

The PaCMMA dynamics are relatively simple; the states and measurements involve very 
simple transformations and the goals of the control law are clear. The system matrix is not 
strongly coupled. Further, many optimization problems find solutions along the boundary 
of the search space. For this reason it may be possible to find an adequate strategy by 
maximizing or minimizing the performance of each actuator seperately. 

Consider the forces acting on the endpoint mass, Mi, in figure 5-2. These two forces 
F-macro an d F m i cro have distinctly different frequency characteristics. When the endpoint is 
stationary against a stiff environment: 
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By design, F m i cro is much faster than F macro . There are two primary operating con- 
ditions to consider. The first is constant force regulation in the presence of disturbance 
forces and the second is force tracking of a desired force input. In the case of constant 
force regulation and transient disturbance rejection, it is clear that the ideal control law 
would attempt to keep F m i cro = 0. In this case, the system's ability to respond to a future 
unknown force transient is maximized. Further, we would like the contribution from the 
macro- actuator, F macro , to reach F^es as quickly as possible. 
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In the case offeree tracking, we would like the control effort from the macro actuator to 
be as fast as possible so that the micro-actuator has the maximum range available to reject 
disturbances. We would also like the micro-actuator to use its full range if necessary. 

In the case where the endpoint is moving with some trajectory x\ = Asm(ujt), the control 
for disturbance rejection is similar. The macro-actuator should modulate the force as best it 
can while the micro-actuator effort should be used to correct for errors. In steady state, the 
micro-actuator should be kept as close to zero as possible. Using these heuristics, the control 
problem becomes one of maximizing the performance of the macro-actuator for the various 
operating conditions and then applying the micro-actuator as a high frequency corrector. 
In the context of rejecting transients, these heuristics will maximize the performance of the 
PaCMMA. 

The previous arguments assume the micro-actuator can be made faster than the force 
applied by the macro-actuator in all contexts. In this case, it is always safe to assume 
that the macro-actuator represents the performance bottleneck. These heuristics are not as 
easily applied if the frequency characteristics of the two force terms, F m i cro and F macro , are 
close in range. 



5.3 Macro- actuator Control 



The goal of the macro-actuator control law is to make F macro as close to F^es as possible. 
Since the transmission and actuator dynamics can be measured, a feedforward controller 
should work well. In addition, the system will need some active damping to prevent excita- 
tion of any unmodelled dynamics and to avoid velocity saturation of the gearhead. Finally, 
the macro-actuator should try to reduce the micro-actuator force to zero. To do this, it can 
use integral gain on the force error. 



F2 = G ff H ff (s)F des 

+ G dl (sX 1 (s)-sX 2 (s)) 

- G d 2sX 2 (s) 

+ (Fdes ~ F e ) 



Several aspects of this control law are important. First, the compliance in the transmis- 
sion allows the use of active damping. The damping terms are very important for stabilizing 
the system. Second, the feedforward model is easily obtained by measuring the system re- 
sponse from Fi to F e and inverting the transfer function. Finally, the integral term will be 
used to make sure that the errors in the feedforward model are reduced when the system 
settles to a constant force. This controller works well and is analyzed in greater detail in 
section 5.5. 
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Figure 5-3: Frequency Response of an electric motor and a force sensor. The 

2 

frequency response function has the form H(s) = s2 2 ^ 2 . 



5.4 Micro- Actuator Control 

The micro-actuator can transmit forces to the endpoint at high bandwidth due to the 
direct-drive connection to the torque sensor. Unfortunately, the velocity of the torque 
sensor deflection is not easily measured and active damping is hard to obtain. 

Integral force control has been shown to be stable against a wide range of environments 
and to be stable when making contact with the environment (Youcef-Toumi and Gutz, 
1989). In fact, integral control provides the best performance for linear closed loop force 
feedback against all environments (Volpe and Khosla, 1993). The form of this control is: 



F = ^(F de 
s 



F P 



Consider a typical open loop transfer function for a force actuator such as an electric 
motor connected to a force sensor (figure 5-3). This figure shows constant gain out to 
some nominal frequency. At this frequency, the resonance of the dynamics between the 
actuator and sensor are excited and a resonance occurs. The actuator force rolls off above 
this frequency. 

Good controller design for a closed loop control law consists of increasing the gain as 
much as possible when phase lag is less than 180 degrees or alternately, by maximizing the 
phase lead at unity gain. It is clear that use of proportional control must decrease the gain 
in order to reduce the magnitude of the transmission resonance. It should also be clear 
that a pure integral control law will increase the gain at low frequency, while decreasing 
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the gain at high frequency. Since the fundamental dynamics have no phase lag up to the 
transmission resonance, the lag from integral gain has relatively little effect on the stability 
at frequencies lower than the first resonance. 

This result is not profound, but should be considered carefully nonetheless. A quasi- 
static motor in free space has radically different dynamics (1/Ms 2 ). This transfer function 
has 180 degrees of phase lag and PD control provides the required phase lead to stabilize 
this plant. Although commonly used for motor position control, PD control laws are not 
indicated for force control and it should come as no surprise that PD control is not as 
effective for controlling force given the difference in the plant dynamics. Force feedback 
with pure integral feedback results in a stable, fast response (Colgate and Hogan, 1989; 
Paljug et al., 1992; Volpe and Khosla, 1992; Youcef-Toumi and Gutz, 1989). 



5.5 PaCMMA Force Control Law 

The control laws of the previous sections can be combined into one control law for the 
PaCMMA. This control law is shown in block diagram format in figure 5-4 and in the 
equations below: 



(5.1} 



where 



Ft = 


^-(F des - F e ) 


F 2 = 


G ff H ff (s)F des 
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K t K t 



(5.2) 



The control law has several components which are used to maximize performance. 

Feed-forward of the desired force (G// < 1) is used to account for plant dynamics with 
estimates of mass, stiffness, and damping. However, backlash, friction and other 
unmodelled dynamics produce errors which require feedback terms. 

Gain G p causes the macro-actuator to reduce the control effort of the micro-actuator 
(which represents the integrated force error). 

Gain G d i provides damping between Mi and M 2 to prevent excessive excitation of the 
transmission. 
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Figure 5-4: Control Law 



Gain G d2 provides damping from M 2 to ground. This is necessary to prevent the macro- 
actuator from exceeding its velocity limits. 

The model developed in chapter 4 is repeated below in figure 5-5. Using the control law 
described above the equations of motion become: 
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Figure 5-5: Lumped Element Model of PaCMMA 



M l s 2 X l {s) = C h-H 1 oL{s){F iRS -K e X l {s)) 

- (K t + B t s) (X 1 (s) - X 2 (,s)) - K e X 1 {s) 



(5.3) 
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+G ff (|V + J- t a + 1 ) Fd - 

+ (K t + B tS )(X 1 (,s)-X 2 (,s)) (5.4) 

These equations may be rearranged to separate the input, F des : 

/ G 1 K e H 10L (s) \ 

^)-v,(.. 



G p GiH 1 ol( s ) 
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+ G ff 


(M 2 2 
\Kt S 


+ f S+1 ) 


(Bt 


+ G dl )s 


A 2 
■■ + K t ■ 




H 10 L(s)K e \ 

s 1 



A" 2 M = I : rV-P ^ L )F,i,, 



where 



Ai(s) = M x s z + -B t s + A e + K t -\ -^ 

A 2 (s) = M 2S 2 + (5 t + G dl + G' d 2)s + A't 



The characteristic polynomial for this 7th order system is: 

A(s) = A 1 (s)A 2 (s) - (K t + B t s) ( (B t + G dl )s + K t - G P G ^o L (s)H b 



General stability analysis for various gains may be performed using equations 5.5 & 5.6 
and the characteristic polynomial. In section 5.7, a procedure for tuning the gains of the 
control system will be presented. 



5.6 Control of the PaCMMA Impedance 

The impedance of the PaCMMA may be controlled using the control law of the previous 
section and a simple impedance model. Figure 5-6 depicts this concept. Position is com- 
manded and the impedance controller determines what force should be applied. This force 
is then used as an input command to the force control system. For first order impedances, 
this may be represented as follows: 

Z des (s) = B des s + K des (5.8) 
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Given a desired position, X des , and the desired impedance about that position, Z des (s), 
the desired force, F des , can be calculated: 



F des (s) = Z des (s)(X(s)- X des (s)) 
= Z des (s)AX(s) 



or 



F des (t) = B des Ax(t) + K des Ax(t) 

In general, it is hard to accurately measure x so simulation of arbitrary masses is not 
trivial. However, estimates or measurements of x are generally achievable. 
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Figure 5-6: Impedance Control Architecture 



5.7 Gain Tuning 

Tuning the gains on the control is more straightforward than it might appear initially. The 
strategy is to first tune the fastest parts of the system so that they are stable and can reject 
all disturbances in a stable manner. Then, the slower parts of the system may be adjusted. 
The following procedure demonstrates this. 

Measure the force control bandwidth from F\ to F e , and determine the appropriate lowpass 
filter to avoid resonance {H\ol)- 

Set Gi so that the integral control of the micro-actuator is as fast as possible. The amount 
of overshoot may be tuned by increasing or decreasing Gi. 

Estimate M2, K t , and B t . With Gr 8 =0, set Gff to so that feedforward response is as 
close as possible to the desired large signal response. Depending on the nature of the 
macro-actuator, the errors may be due to backlash, friction or nonlinearities in the 
transmission. 

With Gr 8 =0, set G d \ to get good force control bandwidth (fixed endpoint) from the macro- 
actuator. The amount of damping required from G d \ will depend on the amount of 
natural damping in the transmission. 

With the micro-actuator operating, set G d 2 to get good position control/impedance per- 
formance from the macro-actuator. If G d 2 is too low then the system will be unstable 
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under position/impedance control. The instability can occur because the feedforward 
model is imperfect and the macro-actuator needs a small amount of phase lead to be 
stable with the feedforward controller. 

Set G p to reduce the steady-state control effort of the micro-actuator. This term of the 
macro- actuator control law should be a small fraction of the total control effort. The 
system will become unstable if it is too large. 

The effect of this procedure is to treat the macro- actuator as a passive stable disturbance 
force which by design is lower bandwidth than the micro-actuator bandwidth. Since integral 
force control on the micro-actuator is stable for all conditions, the overall system is stable. 

5.8 Simulated Control Law Performance 

In order to evaluate the effectiveness of the control law, several simulations were run under 
a variety of scenarios. The performance of the control law is compared to the best possible 
response which could be achieved with perfect knowledge and control. The simulation 
results are described below, while the details of the simulation are discussed in Appendix B. 

5.8.1 Simulated Force Step Response 

Ideal step response performance can be defined a number of ways. In some cases, it is the 
fastest possible rise time. It may also be defined as the fastest rise time with no overshoot or 
the smallest settling time. For the fixed endpoint model of section 4.6, perfect control was 
taken to be the minimum settling time and it was shown that a perfectly timed bang-bang 
strategy is the fastest way to accomplish this. 

The response of the controller to several step changes in the desired force was simulated 
and is compared to the cases for perfect control in figures 5-7 and 5-8. The controller gains 
were selected by observing the step response and using the gain tuning algorithm presented 
in section 5.7. Some judgment comes into play when selecting the amount of overshoot 
and these simulations do not represent an optimal solution. They are intended to show the 
reader that the proposed control law gets close to the optimal solution. 

"Perfect control" for the damped case results in very large force overshoot due to the 
large force contribution from the transmission damping, B t . The plots show that the 
PaCMMA controller proposed in the previous section is slightly slower than the bang-bang 
controller, but force overshoot is smaller. This is probably advantageous in most applica- 
tions. Clearly, a transmission with zero damping and a bang-bang controller produces the 
best response - fast and no overshoot. 
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Figure 5-7: Simulated Force Step Response. F^es = 30 mNm and F^es = 60 mNm. 
This figure shows a comparison of three systems: Bang-bang controi on an undamped 
transmission, bang-bang controi on a damped system and the PaCMMA force controller. 
For the damped case, ( = 0.25 . 
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Figure 5-8: Simulated Force Step Response. F^es = 1000 mNm and F^es = 3000 mNm. 
This figure shows a comparison of three systems: Bang-bang control on an undamped 
transmission, bang-bang control on a damped system and the PaCMMA force controller. 
For damped case, ( = 0.25 
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5.8.2 Simulated Position Step Response 

In many applications the PaCMMA system may be used as a manipulator which follows 
motion trajectories in free space. This section presents a comparison of position controlled 
performance for three simulations: 

Bang-Bang control - The switching times were calculated and the system was simulated 
with saturation as the only performance limit. 

Proportional-Derivative control - A PD controller was designed such that the velocity 
saturation limit on the macro-actuator was violated only for large steps. 

PaCMMA under impedance control - A stiff, but stable impedance was specified for the 
PaCMMA (section 5.6) and step changes in the desired position were specified as 
inputs. A velocity saturation limit was imposed on the control system. 
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Figure 5-9: Simulated Position Step Response. 
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The switching times are easily derived for a Bang-Bang control strategy and a single 
mass: 



and 



' x des M 

"sat 



I X des M 



F. 



sat 



For bang-bang control with two masses connected by a transmission the best case may 
be assumed to be the case where no energy is dissipated in the transmission, i.e. the 
transmission is rigid and all input power is used to move the masses. In this case, the 
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Figure 5-10: Simulated Position Step Response. x,i es = l.Orad 
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Figure 5-11: Simulated Position Step Response. x,i es = 3.0rad 



switching times may be calculated by substituting: F sat = F\ sat + Fi sa t an d M = Mi + Mi- 
This approximation will produce time estimates that represent the fastest possible time. If 
the transmission is non-rigid then the actuator with the lower acceleration will determine 
the response time. 

The PD controller is also simulated assuming a rigid transmission. This will yield 
performance that is unrealistically fast since a stiff, but non-rigid transmission will present 
high frequency dynamics that may be uncontrollable. For this case, it will be assumed that 
a transmission of adequate bandwidth may be used and that the performance is limited 
only by the saturation torque and velocity limits of the two actuators. As with most PD 
controllers, some degree of gain tuning is required to determine what kinds of performance 
are acceptable. Large gains may improve performance for small displacements but result 
in unacceptable overshoot and velocity saturation for large displacements. In most cases, 
the transmission stiffness is not infinite and the small displacement bandwidth is limited 
by the structural bandwidth of the transmission, while the large displacement bandwidth 
is limited by the saturation torques and velocity limit. 



68 CHAPTER 5. CONTROL SYSTEM 

For small signals, it is clear that the PaCMMA is almost as fast as the bang-bang 
controller and faster than the PD controller. This is because the gains that must be used 
by the PD controller are too low for small inputs. Turning up the gains to improve small 
signal performance may cause the velocity limit to be violated. The large signal performance 
shows that the PaCMMA controller is slower than the PD controller. This shows the effect of 
active damping on the velocity of the macro-actuator; The PD controller was not restricted 
to the same velocity limit in this simulation. While the rise time for large steps is longer 
for the PaCMMA controller, the 2% settling time is not drastically different. 

Examination of the control signals reveals that the PaCMMA uses signals that are 
bang-bang initially and then stabilize on the error. Obviously a more clever use of PD 
control, with some non-linear switching, could improve the performance of a position control 
loop. The point of these simulations is to emphasize that the proposed control law for 
the PaCMMA does about as well as can be expected from a system with saturation and 
velocity limitations. (These limitations were ignored for the simulation of optimal bang- 
bang control.) 

5.9 Implementation Issues 

5.9.1 Feedforward Model 

The creation of a feedforward model required a lowpass filter in order to make the system re- 
alizable. This does not present a significant problem because the control system bandwidth 
is significantly higher than the mechanical bandwidth of the macro-actuator /transmission 
system. For this system the feedforward model was: 

(M 2 s 2 + B t s + K t )u 2 n 
s 2 + 1.4Ucj n s + uj 2 n ' ' 

The roll-off frequency, uj n , was 320 Hz. The macro- actuator /transmission had a resonant 
frequency of approximately 2 Hz. 

5.9.2 Force Sensing 

The transmission compliance may be used as a low frequency force sensor provided there 
are no disturbances applied to the endpoint. This may or may not be a valid assumption, 
depending on the application. Figure 5-2 shows the forces which act on the endpoint. A 
balance of forces may be written: 



"e — "micro T "macro T "disturbance Ni\X\ ^O.IUJ 

If the disturbance force, Fdisturbance, is taken to be zero, then the force applied to the 
environment may be derived from measurements of xi, x\ — x 2 and knowledge of F m i cro . 
However, if there is any uncertainty in these measurements, or the model parameters of the 
transmission, then a direct measurement of F e is required. The repeatability and accuracy 
of these measurements is dependent on the transmission implementation and micro- actuator 
model accuracy. 
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5.9.3 Peak Force 

Clever use of the control efforts can produce exceptional small signal performance. Most 
motors have a thermal time constant and can exert peak torque significantly larger than the 
steady state torque. This means that both actuators' control efforts for transient signals 
could be significantly larger than for the steady state case. Performance for impacts and 
step changes in position and force could be made much faster with temporary use of peak 
torque capacity. 
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Chapter 6 

Design Guidelines 



The PaCMMA concept is a general one and as a result, a wide range of possible configu- 
rations exists. This section will identify the relevent design parameters and generate some 
performance relationships. A design procedure will be presented. 

The designer is typically faced with a number of performance specifications which may 
or may not be achievable. Often times the design specifications are not hard constraints 
and are subject to revision as the problem becomes better understood. With that in mind, 
this section will provide some general guidelines for successively pruning the range of con- 
figurations until the designer has a reasonable estimate of achievable system performance. 

6.1 Component Considerations 

Individual component selections will determine the overall response of the system. Some 
of the elements in the design only affect one or two performance dimensions, while other 
components impact every aspect of performance. Each component will be identified and its 
effect on performance will be explained. 

6.1.1 Sensors 

All control systems impose implicit or explicit demands on sensor accuracy. The control 
system proposed in chapter 5 relies explicitly on force measurement. The torque sensor 
should be accurate enough to measure the desired resolution. Since the control algorthim 
relies on integral control, the system will generally attempt to control the system down to 
1 bit error. 

The control system also relies on position measurements. The position sensors on the 
micro and macro- actuators are used for measuring the actual robot position and for creating 
computational damping in the transmission. These two uses may not require the same 
accuracy. In the case of determining robot position, this requirement is dependent on the 
task and the impedance requirements. A stiff impedance requires more precise position 
measurement since force must change over a small displacement. 

Active damping is the second use of position information. In order to get good resolution 
for damping, position resolution needs to be scaled inversely with the transmission stiffness. 
A stiff transmission requires fine position resolution in order to measure the deflection of 

71 
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the transmission. This requirement is generally not a hard one to satisfy in the PaCMMA 
since the transmission is usually explicitly compliant and high accuracy position sensors are 
a well developed technology. 

6.1.2 Micro-actuator Selection 

The endpoint inertia, Mi, is the sum of the link inertia and the rotor inertia of the micro- 
actuator and has the greatest effect on the system's performance during endpoint motion. 
The impedance and impact relationships derived in chapter 4 show that this quantity should 
be minimized. Often, the link inertia is significantly larger than the rotor inertia so that 
the rotor inertia is not a dominant constraint on the design. 

The maximum acceleration is another important quantity in determining the impedance 
of the endpoint. The actuator torque is finite and the acceleration is limited. When the 
quantity, XiMiuj 2 / F\ sat , is less than one, the micro-actuator torque (with perfect control) 
can eliminate the inertia of the link mass 1 . When this number exceeds one then the micro- 
actuator can reduce, but not eliminate the impedance due to the endpoint inertia. As such, 
the ratio Mi/Fi sat (maximum acceleration) must be chosen to provide the desired small 
signal impedance performance. 

Friction between the source of effort, F\, and the point of contact, F e (i.e. brush and 
bearing friction) will result in a measurable error or limit cycle (depending on the use of 
proportional or integral control). The magnitude of the error or limit cycle is directly related 
to the magnitude of the friction, therefore friction should be minimized (Townsend, 1988). 

In the distributed configuration (figure 2-1), the micro-actuator may be mounted some 
distance from the macro actuator and its housing inertia may affect the dynamics of another 
joint. In general, one should seek to reduce the inertia of the micro-actuator housing if it is 
mounted on a moving link. The effect of the micro-actuator housing inertia will be on the 
previous link, not the link being controlled by the micro-actuator. 

The micro-actuator is connected to ground in all configurations of the PaCMMA sys- 
tem. This is a fundamental requirement of the design. However, it is worth noting that 
this connection need not be "rigid". In fact, the only requirement is that the connection be 
dynamically stable and have dynamics that are lower bandwidth than the micro-actuator 
force response, R\cl- The movement of the housing in a non-rigid connection is seen as an- 
other disturbance and that disturbance may be rejected by the controller if the disturbance 
is slower than the micro-actuator. Mounting the micro-actuator housing in a well-damped 
support should not present a difficult design task. 

6.1.3 Transmission Selection 

The transmission stiffness is an extremely important characteristic. Varying the trans- 
mission stiffness allows the designer to trade off low impedance against high force control 
bandwidth. To illustrate this point, consider figure 6-1 which shows the force control band- 
width of the PaCMMA for increasing transmission stiffness, K t . As expected, the force 



A manipulator may idealized as a mass with a force source. When a position trajectory, Asm(uit), is 
desired, the force required is F = M\u> Asm(uit). Thus, when the actuator saturates at F = F\ sa t, the ratio, 
X\M\lo /Fi sa t is greater than one. 
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control bandwidth increases as the transmission stiffness increases. 




10 10 

Frequency, Hz 

Figure 6-1: Force Control Bandwidth for Varied Transmission Stiffness. The force 
control bandwidth was calculated using equation 4.13 and the simulation parameters can 
be found in Appendix A. The transmission stiffness, K t , was given the following values: 
114,1.14 X 10 3 ,1.14 X 10 4 ,1.14 X 10 5 ,1.14 X 10 6 mNm/rad. 



It should be noted that this figure assumes constant damping ratio. In reality, damping 
gets harder to implement as the transmission stiffness increases and a low pass filter below 
the resonant frequency is generally required. As a result, the gains in bandwidth are not as 
great as shown in this figure. Nonetheless, high transmission stiffness generally results in 
high force control bandwidth. 

Unfortunately, a stiff transmission creates a larger passive impedance. When the ac- 
tuators saturate or the dynamics are faster than the control law, the system performance 
reverts back to the passive dynamics of the system. Figure 6-2 shows the passive (undriven) 
impedance of the PaCMMAfor varying transmission stiffnesses. There are two asymptotes, 
(Mi + M2)s 2 and M\s 2 and the transmission stiffness is varied to modify the impedance 
at a given frequency. A very soft transmission results in the impedance approaching the 
1/Mis 2 asymptote at a low frequency, while a stiff transmission causes this to occur at a 
higher frequency. In other words, the soft transmission reduces the effect of mass Mi at a 
lower frequency. The designer must chose between force control bandwidth and low passive 
impedance based on the application. 

The transmission impedance (stiffness and damping) also impose some stability limits. 
Typically, transmissions are made of aluminum or steel both of which are poorly damped. 
Undesired resonances in the system may be controlled three ways: 

• Passive mechanical damping may be introduced to the transmission 
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10 
Frequency, Hz 

Figure 6-2: Passive Impedance for Varied Transmission Stiffness. The pas- 
sive impedance of the system was calculated using equation 4.17 and the parameters 
in Appendix A. Inputs F\ and Fi were set to zero. Two asymptotes, M\s 2 and 
(Mi + M2)s 2 are also shown. The transmission stiffness, K-t, was given the following values: 
114,1.14 X 10 3 ,1.14 X 10 4 ,1.14 X 10 5 ,1.14 X 10 6 mNm/rad. 



• Active damping may be added using velocity measurements 

• The control signal can be lowpass filtered to avoid the system resonance altogether 

Typically, mechanical damping alone is insufficient. Computational damping is less 
effective as the stiffness increases since position measurements (and therefore velocity mea- 
surements) become smaller and harder to measure. A low pass filter is easily implemented, 
but is overly conservative in bandwidth. The PaCMMA concept requires active damping 
of the transmission in the control of the macro-actuator and as a result, an extremely stiff 
transmission will have the effect of destabilizing the macro-actuator. The micro-actuator 
also uses a lowpass filter to avoid resonance since neither velocity measurements nor passive 
means are sufficient. 



6.1.4 Macro-actuator Selection 

The macro-actuator is generally the easiest component to select since it is not subject to 
the same low friction and low mass requirements as the micro-actuator. 

Saturation torque of the macro- actuator determines the maximum torque for the system. 
This is typically an easy requirement to meet since the macro-actuator may be located some 
distance from the robot endpoint. 
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Maximum acceleration, F2 sa t/M2, proves to be an important specification for the macro- 
actuator. Maximum acceleration combined with the transmission stiffness determines the 
large signal bandwidth of the PaCMMA system. If the macro-actuator is slow then the 
rate of change of force due to the macro-actuator will be small. Conversely, if the macro- 
actuator is fast, then the rate of change of force will be large. The macro- actuator clearly 
benefits from high power density. If large signal bandwidth is not an important specification, 
then a reduction may be used to obtain greater torque density from a low power actuator. 
Impedance is also affected by acceleration performance. If the maximum acceleration is 
small, then the macro-actuator will saturate at a lower frequency and the passive dynamics 
of the system will dominate at a lower frequency. 

For many of the reasons mentioned above, velocity saturation also imposes similar limits 
on the force bandwidth and impedance of the system. The macro-actuator reduction will 
determine whether velocity saturation or acceleration limits dominate the performance of 
the macro-actuator. 

Reductions (gear, cable, or friction drives) may be used to great advantage on the macro- 
actuator but a few caveats are in order. A large reduction allows the designer to generate 
large torque density from a low power actuator. For many applications where size, weight, or 
cost present limitations and large signal bandwidth is not required (e.g. slow manipulation), 
the use of a reduction is desirable. However, a transmission reduction (e.g. a gearhead) 
generally introduces nonlinear dynamics such as friction and backlash. In the experiments 
which will be reported in chapter 7, backlash proved to be a very undesirable characteristic. 
In short, backlash is a complex nonlinearity which introduces error signals at frequencies 
above the frequency of excitation. This harmonic distortion can not be eliminated by the 
micro-actuator when it occurs above the bandwidth of the micro-actuator control system. 
For this reason backlash should be avoided. 

When the system is heavily loaded (i.e. a large mean force) and power required from the 
macro-actuator is relatively low (slow changes in position/force), the backlash effects may 
be reduced or eliminated since the gearhead is always loaded with a bias force. However, 
the gearhead can still become unloaded during very fast changes in the position of the 
macro-actuator. Even though the force applied to the output shaft of the gearhead stays 
positive, the force applied to the input shaft can become negative and an impact will occur 
as the gear teeth unload, move in free space and then load in the opposite direction. This 
introduces another undesirable high frequency disturbance force. 

Conversely, friction and/or stiction in the reduction does not pose a large problem. 
Friction acts as an additional form of velocity damping and the only negative effect is the 
excess power that is consumed. Except for power efficiency concerns, nominal amounts of 
friction should not be detrimental to the system performance. 

6.2 Design Procedure 

Given the heuristics described above and the performance relationships derived in chapter 4, 
the designer can now develop some kind of quantitative performance relationships for a 
PaCMMA system. The calculations of the previous chapters incorporate a large number 
of parameters. A complete search of the design space for simultaneous solutions to all 
performance criteria might yield a solution, but an iterative less exhaustive approach is more 
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likely to yield an acceptable solution in a reasonable amount of time. The following section 
breaks the actuator into its component parts and presents an iterative design procedure. 
The process is as follows: 



• 



• 



Select a force sensor - The resolution and performance of the system is entirely de- 
pendent on the force sensor. Be sure that quantization noise from A/D conversion is 
acceptable. 

Determine the small signal force bandwidth requirement - The small signal force 
bandwidth is limited by the mechanical coupling between the force sensor and the 
micro-actuator. The first system resonance will need to occur at a frequency above 
the desired force bandwidth in order to maintain stability of the control law. The 
exact requirements will be determined by the passive damping of the connection. For 
example, aluminum is poorly damped and could require a transmission bandwidth 4-6 
times higher than the desired force bandwidth. 

• Determine the maximum acceleration required - The maximum required acceleration 
is driven by both the small signal position bandwidth and the minimum impedance 
performance. When F\ sat < MiX,i es tjj 2 , the small signal impedance and position 
performance must deteriorate. 

• Select a micro actuator with acceptable F\ sat - Based on the manipulator inertia, Mi, 
and the desired small signal performance, a micro-actuator can be selected. The brush 
friction of the micro-actuator should be smaller than the desired resolution. 

• Select servo rate - The servo rate should be 8-10 times faster than the first resonance 
between the force sensor and the micro-actuator. This will ensure adequate control 
of the resonance under integral force control. 

• Close the control loop on the micro-actuator and evaluate small signal force band- 
width and impedance - At this point the micro-actuator gain, Gi, and the lowpass 
filter, H\ol{s), should be tuned to provide the desired small signal force bandwidth, 
impedance and position control response. Inadequate performance should be cor- 
rected at this time by reducing mass, increasing torque and increasing the stiffness of 
the torque sensor coupling. 

The system with only the micro-actuator represents the best case performance for small 
signals. With these limits established, the designer must now select the macro-actuator and 
the transmission. The dominant parameters are K t , F2 sa t, and M^- 

• Determine large signal force bandwidth requirements - Large signal force bandwidth 
will be limited by \/K t /M 2 . 

• Determine the maximum acceleration from large signal impedance and position control 
requirements. As stated above, when Fi sa t < A^X^s^ 2 : , the system performance will 
degrade. 

• Check for velocity saturation - velocity saturation will degrade large signal perfor- 
mance. 
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• Select transmission and macro-actuator as a coupled pair 

Appendix A contains detailed response data for the the prototype system. 

6.3 Force Control Performance Space 

Nearly all actuator systems have amplitude and frequency limitations and the PaCMMA 
is no different. The performance relationship between the micro- actuator and the macro- 
actuator was illustrated in Chapter 3 and is repeated in figure 6-3. The region defined 
in this plot is the similar to the region defined by the force control performance plot in 
figure 4-6 . 



^ Macro 
\7) Micro 




0) 

Figure 6-3: Performance Space for the Micro and Macro-actuators. The regions 
are bounded by curves of constant error. 



The performance advantages of the PaCMMA are clear when visualized in performance 
space. Examining figure 6-3, it can be seen that the macro-actuator has a large force am- 
plitude but relatively low frequency while the micro-actuator can produce small amplitude 
but at high frequency. Figure 6-4 shows the performance of the PaCMMA system. It is 
clear that the force control performance of the PaCMMA is the union of the micro and 
macro-actuators. This will be experimentally verified in Chapter 7. 
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□ PaCMMA 




Figure 6-4: Force Control Performance Space for PaCMMA System 



6.4. EXTENSION TO N-ACTUATORS 
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6.4 Extension to N- Actuators 

The ability to form the union of two different operation spaces raises the obvious question: 
If two actuators are better than one, are three actuators better than two? Figure 6-5 depicts 
this concept. 
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Figure 6-5: N-Actuator Concept 



Extension of the concept to more than two actuators is clearly possible. With regard 
to force control performance, the operation space concept makes it clear that actuators 
with different operating spaces may be coupled to increase the operating region. Of course, 
additional actuators will create additional impedance which may be a detriment, depending 
on the application. Finally, additional actuators bring additional mechanical complexity. A 
more thorough analysis of the multi-actuator concept is worth pursuing. 



6.5 Integration into Existing Systems 

The PaCMMA concept is clearly capable of providing better performance than a single 
actuator system. The reader may be wondering how to take advantage of this concept 
on an existing manipulator. There are two conceptual possibilities when converting an 
existing system to a PaCMMA configuration: addition of a micro-actuator or addition of a 
macro- actuator. 

Adding a macro- actuator to an existing system is a relatively simple prospect. All 
that is required is a point to attach the compliant transmission. For example, suppose we 
have a system with good force and position bandwidth, but the system is not powerful 
enough. One simply adds a pulley onto the existing drive axis and connects the PaCMMA 
transmission to the pulley. The macro-actuator may be located some distance away from 
the joint if necessary. The addition of the macro-actuator provides a substantial increase 
in force range without reducing the original system performance! There would be a small 
increase in impedance due to the additional actuator, but examination of the results in 
chapter 7 should provide a convincing argument for the PaCMMA configuration. 

Addition of a micro- actuator is likely to be more difficult. The goal in this case is to 
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find a way to attach a micro-actuator to the endpoint using a high bandwidth coupling. 
This may be accomplished one of two ways. The first method is simply to attach the 
micro-actuator to the joint axis where the single actuator was attached. This may yield an 
improvement in force resolution but will not improve bandwidth. The second method is 
to find a way to connect the micro-actuator to the endpoint with a coupling that is higher 
bandwidth than the existing actuator coupling. This might entail mounting the micro- 
actuator closer to the force sensor and the point of force application. The reduced size of 
the micro-actuator will make this possible in some configurations, while other systems will 
be too tightly constrained to allow this modification. 

6.6 Nonlinear Transmissions 

Examination of contact tasks in manipulation suggests that low stiffness and low impedance 
are most important when a manipulator has a collision or deliberately makes contact with 
the environment. In both of these cases the transmission deflection is typically small prior 
to contact because the endpoint is light. If the contact force becomes large during a manip- 
ulation, low transmission stiffness may not be as important. For this reason, a nonlinear, 
stiffening transmission is worth considering. A stiffening transmission offers the benefit of 
low stiffness and impact energy when making contact with the environment while reduc- 
ing the transmission volume and increasing the maximum force range. In fact, a stiffer 
transmission may result in better large signal performance. 

Two other aspects of transmission design are the range of forces that the transmission 
will withstand without deforming and the volume required for the transmission to deflect 
under full load. A soft transmission offers low impedance but can not typically withstand a 
large applied force. A soft transmission also requires a large volume in which to compress 
and expand. Conversely, a stiff transmission can withstand high loads but will not produce 
the desired reduction in impact energy and impedance. 



Chapter 7 

Experimental Results 



This chapter reports on the experimental results obtained with a prototype testbed. In 
order to better understand the advantages and disadvantages of the PaCMMA system, an 
experimental comparison was performed between the PaCMMA and several other compo- 
nent configurations. 

7.1 Prototype 

A prototype actuator system was assembled to test the parallel actuator concept (figure 7-1) 
and specifications for the system components are contained in Appendix A. A third motor 
was used to provide environment dynamics, i.e. to simulate a moving environment. 

In addition to the PaCMMA testbed, the performance of the macro-actuator (a per- 
manent magnet, DC brushed, gear head motor) connected to a traditional transmission and 
controller was measured in order to provide an accurate comparison between the PaCMMA 
concept and traditional actuator implementations. The performance of the micro-actuator 
also yields insight into the performance enhancements of the PaCMMA concept. 

In the following sections, results will be reported for several actuator configurations. 
The configurations are listed in table 7.1. 



Test Configuration 


Actuator 


Transmission 




Controller 


1 


Micro Only 


Direct Drive ( 


;300 Hz) 


Impedance 


2 


Macro Only 


Stiff Cable 




Impedance 


3 


Macro Only 


Stiff Cable 




PD position 


4 


PaCMMAl 


Compliant 




Impedance 


5 


PaCMMA2 


Compliant 




Impedance 



Table 7.1: Experimental Configurations 

The first configuration is a traditional design though it is direct-drive. The micro- 
actuator is attached to the joint with a solid aluminum shaft and the direct drive connection 
puts the force bandwidth of this system up near 60 Hz. Appendix A contains a frequency 
response plot of the open loop dynamics of the micro-actuator and torque sensor. 
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Figure 7-1: PaCMMA Prototype 

The second configuration is a traditional, "stiffer is better" design. The macro- actuator 
is located remotely and a cable drive transmission transmits power to the joint. Using this 
configuration, the first resonance in the force response occurs at 12 Hz. The macro-actuator 
uses a 36:1 planetary gear head. 

The third configuration uses the same hardware as configuration 2, but the control 
system uses a PD position control architecture. In this configuration the system is run 
under position control, which is sometimes called open-loop impedance control. In this case, 
the force is not measured and it is assumed that the torque commanded to the actuator is 
transmitted to the endpoint with minimal losses. 

Configurations 4 & 5 represent the PaCMMA with two different transmissions. The 
first configuration, PaCMMAl, uses a transmission stiffness, K t of 1140 mNm/rad. The 
second configuration, PaCMMA2, uses 1^=3000 mNm/rad. The majority of the tests are 
performed with PaCMMAl except for impedance, which is measured for both systems. 

7.2 Performance Data 

In order to evaluate the performance of the actuator system, a number of performance met- 
rics must be defined. It is common to evaluate actuators on performance specifications such 
as power/mass and force/mass. These specifications are useful but neglect several impor- 
tant dynamic characteristics which affect performance in robot haptics and manipulation. 
To quantify robot characteristics in force controlled tasks, I will present several measures 
of performance. 



Force Control Frequency Response 
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• Force Control Step Response 

• Force Fidelity (Distortion) 

• Force Control Performance Space 

• Impedance Frequency Response 

• Position Control Frequency Response 

• Position Control Step Response 

• Impact Response 

• Control of the PaCMMA Impedance 

• Dynamic Range and Precision 

The results of the experiments using these measure are presented in table 7.2. 

Before presenting the data, a few remarks are in order. Frequency response measure- 
ments do a good job of presenting a large amount of information, but may not reflect true 
response if the output signal is not a pure sinusoid. Nonetheless, they provide a useful way 
to compare the performance of various systems. For the results presented in the following 
sections, the frequency response was calculated by determining the Fourier coefficients of 
the input and output signal at the excitation frequency. From these values, phase and am- 
plitude of the transfer function were determined. The system is amplitude dependent due to 
saturation of the micro-actuator. Further, friction and backlash contribute to the response 
in a nonlinear manner which depends on both frequency and amplitude. As a result, the 
response of the system to small disturbances is not the same as the system response to 
large disturbances. Response data for both large and small disturbances will be presented 
in order to illustrate this point. 

Time domain measurements such as rise time and settling time are also useful since many 
applications will rely on step inputs and many disturbances are fast enough to approximate a 
step function. It is important to remember that step response inputs are the least "smooth" 
and therefore are most likely to saturate the inputs. Avoiding these kinds of discontinuities 
at the control inputs will reduce high frequency transients. 
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Micro 


Macro 


PaCMMAl 


PaCMMA2 


56 Hz 


12 Hz 


56 Hz 


56 Hz 


NA 


12 Hz 


4.5 Hz 


8 Hz 


60 Hz 


3 Hz 


60 Hz 




NA 


20 Hz 


8 Hz 




10 Hz 


a ,1.6 b Hz 


10 Hz 




6 Hz 


4 c ,1.6 b Hz 


3 Hz 




10 Hz 


0.16 Hz 


2.9 Hz 


2.9 Hz 


5 Hz 


0.08 Hz 


1.6 Hz 


1.6 Hz 


83 mNm 


495 mNm 


66 mNm 




252 mNm 


1400 mNm 


240 mNm 




58:1 


52:1 


800:1 




1.7% 


1.9% 


0.12% 





Force Control Bandwidth 
Small - F des =0.08 sm(ut) Nm 
Large - i^ es =0.32 sin(u;i) Nm 

Force Distortion less than 20% 
Small - F ( i es = 30 sin(u;i) mNm 
Large - F ( i es = 400 sin(u;i) mNm 

Position Bandwidth 
Small - Xdes=0.014 sin(u;i) rad 
Large - Xd es = l.l sin(u;i) rad 

Impedance Bandwidth (_F^ es =0) 
Small - Xi n =0.23 sin(u;i) rad 
Large - X 8n =0.92 sin(u;i) rad 

Maximum Impact Force 
V = 1.9 rad/sec 
V = 7.5 rad/sec 

Force Dynamic Range 

Force Precision 



NA - test could not be performed 
Performance was insufficient for test 

Using impedance controller 
c Using PD controller 



Table 7.2: Performance Summary 
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7.2.1 Force Control Response 

The force control response of the PaCMMA approaches the theoretical predictions of Chap- 
ter 4. The small signal bandwidth of the micro-actuator is maintained, while the bias force 
is determined by the macro-actuator. Recall the definition of force control response from 
Chapter 4: 



HJcj) 



FeH 

F d (oj) 



x e =o 



Force control bandwidth was measured by clamping the endpoint to a rigid environ- 
ment and setting the desired force to be a number of sinusoids of different amplitudes and 
frequencies. Since saturation is an important characteristic of this research, frequency re- 
sponse measurements were taken with a variety of desired amplitudes as well as at a variety 
of mean force values. Step responses were measured by simply applying various step changes 
in desired force from various bias forces. The data for these experiments is presented below. 
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Figure 7-2: Small Signal Force Control Bandwidth. Fd es = 0.08, F 2sa t = 0.57-Fi sa t. 
Performance was measured using explicit force control 



As expected, the force control bandwidth of the PaCMMA for small signals (figure 7-2) 
is nearly as good as the response of the micro-actuator alone (56 Hz). However, the large 
signal performance (figure 7-3) of the PaCMMA (4-6Hz) is lower than the macro-actuator 
can achieve with a stiff transmission (12Hz). This is expected - the ability of the macro- 
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Desired Torque = 260.0 mNm 



PaCMMA2, K=3000 
PaCMMAl, K=1140 
Macro Only 



Frequency, rad/sec 




Frequency, rad/sec 



Figure 7-3: Large Signal Force Control Bandwidth. F,i e 

Performance was measured using explicit force control. 



0.32, Fisat — 2.3-Fisaf 



actuator to transmit force is directly affected by the transmission bandwidth. Since the 
PaCMMA transmission is softer than the stiff cable transmission, it can not use the large 
signal capacity of the macro-actuator as effectively. Figure 7-4 shows how the theoretical 
performance curve from section 4.4 compares to the actual bandwidth measurements. The 
data from all of the force control experiments is plotted in this figure. The difference in the 
experiment and theory reflects the non-perfect performance of the control law. 

The step response of the PaCMMA is also as expected. Small changes in force are 
very fast (f 5msecs), while large changes in force require the macro-actuator to displace the 
transmission a significant distance. The slower response reflects the velocity and acceleration 
limits of the macro-actuator. This performance can be improved by choosing a macro- 
actuator with faster acceleration, or by choosing a stiffer transmission. 

Figure 7-5 shows a small oscillation after the step value has stabilized. This oscillation 
is caused by the transmission springs vibrating after the sudden change in displacement 
of the macro-actuator. As mentioned in section 4.9.5, the transmission was modeled as a 
mass-less spring and damper. Since the unmodelled resonance (fOO Hz) occurs above the 
frequency of the micro-actuator control system, there is no way to actively suppress it. A 
solution to this problem is to reduce the resonance of the transmission by a) increasing the 
transmission mass to reduce the frequency of oscillation or b) to add enough damping to 
eliminate the resonance all together. 

It is clear that large signal force control performance is not maximized with the PaCMMA 
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Figure 7-4: Force Control Response — Theory vs. Experimental. Solid lines repre- 
sent swept sinusoidal inputs at various force amplitudes. 



concept. Nonetheless, the performance gains in some of the experiments that follow will 
more than justify the concept for many applications. 
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Figure 7-5: Large Step Response for PaCMMAl. The small oscillations in the force 
which persist after reaching the desired force represent the unmodelled dynamics in the 
transmission. The steel extension springs are vibrating at 100 Hz due to the sudden change 
in force. Since this disturbance is greater than the micro-actuator bandwidth, they can not 
be suppressed. 
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Figure 7-6: Small Step Response for PaCMMAl. This graph shows the fast response 
to small steps, regardless offeree bias. The rise time is approximately 15 milliseconds. 
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7.2.2 Force Fidelity 

The force fidelity of the PaCMMA was very good. The micro-actuator was able to reduce 
distortion up to 60Hz. A metric for least squares distortion was described in Chapter 3. 
Figures 7-7 and 7-8 show the force fidelity versus frequency for small and large amplitudes. 
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Figure 7-7: Small Signal Distortion. Fdes = 13 mNm. The figure shows that the 
PaCMMA and the micro-actuator perform much better than the macro-actuator for small 
amplitude force commands. While a force bias improves the performance of the macro- 
actuator somewhat, it is still not as accurate as the PaCMMA or the micro- actuator. 



Figure 7-7 shows the response of the system to a small force command (13mNm = 
10% Fi sa t). The macro-actuator alone is very distorted. This is due to the friction and 
backlash that are introduced by the gearhead. A second trial with the macro-actuator was 
performed with a large bias (390mNm). The distortion was improved but still falls short of 
the performance that can be obtained with the micro-actuator and the PaCMMA. 

Figure 7-8 shows the large signal force fidelity. In this case, the PaCMMA signal dete- 
riorates first, but this is largely due to attenuation (remember the force bandwidth of the 
PaCMMA is lower than the macro- actuator for large forces). As the frequency increases 
the PaCMMA maintains a higher level of fidelity. 
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Figure 7-8: Large Signal Distortion. F^es = 520 mNm. The macro-actuator performs 
more accurately than the PaCMMA for some frequencies, but the PaCMMA fidelity is 
better overall. 
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7.2.3 Force Performance Space 

The force performance space data of the experiments does a good job of simultaneously 
displaying the bandwidth data and the distortion data of the previous sections. Figures 7- 
9 and 7-10 show the performance space for the individual actuators and the PaCMMA 
respectively. 
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Figure 7-9: Force Performance Space for Macro and Micro Actuators. The force 
control response data of section 7.2.1(explicit force control) was analyzed to determine the 
amplitudes and frequencies at which the RMS error was less than 10%. 



On figure 7-9, the macro and micro-actuator performance boundaries delimit different 
regions of the space. Notice that the error boundary for the macro-actuator shows the 
degradation of signal accuracy at small amplitudes. 

Figure 7-10 shows the performance space for the PaCMMA. The performance of the 
micro- actuator is preserved and the overall performance is augmented by the macro- actuator. 
The contribution from the macro- actuator is smaller than in figure 7-9 but this was expected. 
The PaCMMA transmission is softer than the transmission used for the macro-only tests 
and thus, will not be able to transmit force at the same bandwidth. 

The ability to augment the performance of the high-performance micro-actuator with 
large bias forces is an important result. In the next sections, the benefits for using a 
compliant transmission will be shown. The reduction in large signal force bandwidth is the 
price that is paid. 



92 



CHAPTER 7. EXPERIMENTAL RESULTS 



1200F 



1000 - 



800 



| 600 - 

I 

< 400 



200 - 




/ Error < 10% 



50 



100 150 



200 250 300 

Frequency, rad/sec 



350 400 450 



500 



Figure 7-10: Force Performance Space for PaCMMAl. The performance space of the 
micro and macro-actuators is included. This shows how the PaCMMA's parallel coupling of 
the micro and macro-actuators can be used to get better performance than either actuator 
operating alone. 
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7.2.4 Impedance Response Bandwidth 

The compliant transmission of the PaCMMA was shown to reduce the impedance dramat- 
ically. Impedance response was also measured using the definition from chapter 3: 



Z(u) 



F P , 



u 



XiJu) 



F(i es =constant 



For these measurements a high torque, position controlled motor was attached to the 
end effector and used to create position disturbances. Position disturbances of varying 
magnitude and frequency were applied to the PaCMMA with i^ es =0. The results here 
show the minimum achievable impedance for the PaCMMA system. The results of the 
impedance response measurements are given below. 
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Figure 7-11: Small Amplitude Impedance Response. Impedance response data is 
shown for i^ es =0. All systems used explicit force control algorithms. 



Several aspects of the data are noteworthy. First, there is a minimum impedance value 
which represents the force noise level divided by the displacement amplitude. This lower 
limit is created by the force measurement resolution. As the frequency of the disturbance 
increases, the impedance begins to increase. Several effects are responsible for this increase. 
When the micro-actuator saturates, it can no longer cancel the inertial force of the end- 
point mass. When the macro-actuator saturates, it can no longer keep the transmission 
from deflecting. The relative magnitude of each term (F macro and F m i cro ) depends on the 
amplitude of displacement and the component specifications. 

A comparison of the three cases shows that the macro-actuator with a stiff transmission 
presents the largest impedance while the micro-actuator presents the smallest impedance. 
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Figure 7-12: Large Amplitude Impedance Response. Impedance response data is 
shown for i^ es =0. All systems used explicit force control algorithms. 



The PaCMMA generates an impedance in between these two values. It should be clear that 
the stiff transmission creates a large impedance while the compliant transmission creates 
a smaller impedance. The data for the micro-actuator and macro-actuator alone provide 
bounds on the maximum and minimum impedance. 
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7.2.5 Position Control Experiments 

The PaCMMA was run using the impedance controller of Chapter 5 and commanded to 
follow both step and sinusoidal position trajectories. The desired impedance was set to the 
stiffest impedance possible in order to maximize the position bandwidth. The results of 
these tests are shown below. 
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Figure 7-13: Large Signal Position Bandwidth. X,i es = 62.0 degrees 



Figure 7-13 shows the position bandwidth of four systems. The micro-actuator, macro- 
actuator and PaCMMA were run with the impedance control method described in Chap- 
ter 5, and the macro-actuator was also run with a standard PD position control law. Clearly, 
the micro-actuator offers the highest bandwidth, and the macro-actuator under impedance 
control is the slowest. The PaCMMA position performance is almost as good as the macro- 
actuator under PD position control. This is a particularly useful though initially unexpected 
result. 

For force control bandwidth, the PaCMMA's transmission compliance limited the large 
signal bandwidth. For position bandwidth the large signal performance actually exceeds 
the performance that could be achieved with only the macro-actuator and the compliant 
transmission. The micro-actuator stabilizes the vibrations that arise from the step input 
and the transmission compliance. As a result, the control effort to the macro- actuator can 
be very large and discontinuous (i.e. Bang-bang) without the penalty of transient vibration. 

For small position commands it is clear that PaCMMA performance is as good as the 
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Figure 7-14: Small Signal Position Bandwidth. Xde S =0.8 degrees, Backlash 
degrees 



0.7 



micro-actuator alone while backlash limits the performance of the macro-actuator. 

The step performance in figure 7-15 shows that the PaCMMA can perform step moves 
with faster rise time and less overshoot than the macro-actuator under conventional PD 
position control. 

Overall, the PaCMMA system is able to recover the full position performance of the 
macro-actuator while reducing the endpoint impedance through the use of a complaint 
transmission. 
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Figure 7-15: Large Step Response. F^es = 62.5 degrees 




Figure 7-16: Small Step Response. F^es = 3.125 degrees 
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7.2.6 Impact Experiments 

Impacts highlight the effectiveness of the PaCMMA's low impedance. The PaCMMA was 
given a velocity input command (V ) and programmed to stop when impact was detected 
based on a force threshold of 20mNm. Thresholds smaller than 20mNm could not be used 
because the inertial force of the accelerating link caused the threshold to trigger. The results 
of these tests are shown in figures 7-17& 7-18. 
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Figure 7-17: Impact Response. V = 1.9 rad/sec. This graph shows the drastic reduction 
in impact force when a compliant transmission is attached to the macro-actuator in the 
PaCMMA system. Notice that the PaCMMA transients settle more quickly than even the 
micro-actuator by itself. 



The reduction in impact force is substantial. In fact, it is clear that the PaCMMA has 
the fastest settling response. One nice feature in these results is the minimal bounce of 
the end effector. While the impact forces are certainly a function of velocity, the position 
response of the system is stable and monotonic. 

Several other issues are demonstrated by these experiments. First, the control law is a 
single impedance control law which does not rely on any switching behavior upon impact. 
Position commands are easily followed, and force is accurately controlled. Second, impacts 
typically occur in under a servo cycle. The energy transmitted to the environment from the 
endpoint is unavoidable. The intentional use of compliance in the transmission prevents the 
kinetic energy of the macro-actuator from being dissipated during the collision. 
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Figure 7-18: Impact Response. V = 7.5 rad/sec. 
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7.2.7 Control of PaCMMA Impedance 

The PaCMMA was programmed to exhibit different impedances using the impedance con- 
trol architecture described in section 5.6. Figures 7-19 through 7-24 show the performance 
of the PaCMMA, micro and macro-actuators for three impedances. 

A comparison of the data shows the added range of the PaCMMA in each of these 
tests. For large displacements, it is clear that the micro-actuator has limited capability 
for simulating impedances despite the direct-drive bandwidth. The PaCMMA does a much 
better job of emulating the same impedance at larger amplitudes. 
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Figure 7-19: Programmed Impedance. Z(s) = 10 + 0.66s (Small Displacement). This 
shows that the micro- actuator and PaCMMA can effectively produce the desired impedance. 
The macro-actuator can not emulate the impedance as accurately. 
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Figure 7-20: Programmed Impedance. Z(s) = 10 + 0.66s (Large Displacement). For 
large disturbances, the PaCMMA outperforms both the micro and macro-actuators. The 
micro-actuator saturates and can not produce enough force. An additional benefit of the 
PaCMMA is that its high frequency impedance is much lower than the macro-actuator. 
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Figure 7-21: Programmed Impedance. Z(s) = 0.67+ 0.25s (Small Displacement) 
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Figure 7-22: Programmed Impedance. Z(s) = 0.67 + 0.25s (Large Displacement) 
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Figure 7-23: Programmed Impedance. Z(s) = 10 + 0.02s (Small Displacement) 
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Figure 7-24: Programmed Impedance. Z(s) = 10 + 0.02s (Large Displacement) 
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7.2.8 Dynamic Range and Force Precision 

The force precision and dynamic range of the various systems are as follows: 

Force Precision (%) Force Precision (absolute) Dynamic Range 

Micro Only 1.7% 1.3mNm 58:1 

Macro Only 1.9% 15 mNm 52:1 

PaCMMA 0.12% 1.3mNm 800:1 

Clearly the PaCMMA offers a dramatic improvement in precision and dynamic range. 



Chapter 8 

Conclusions 

8.1 Contributions 

This thesis makes several contributions to the area of actuator research. The parallel coupled 
micro-macro actuator system (PaCMMA) described in this thesis was shown to exhibit 
superior characteristics when compared to typical single actuator systems. The benefits of 
this system are: 

• Improved Small Signal Force Control Bandwidth 

• Reduced Impedance (more backdrivable) 

• Reduced Distortion 

• Reduced Impact Forces 

• Improved Small Signal Position Bandwidth 

• Improved Force Resolution and Dynamic Range 

In addition to the actuator system, this thesis also formalizes several performance met- 
rics so that designers will have a more complete set of tools when choosing actuator systems. 

8.2 Thesis Summary 

This thesis presents an actuator concept which combines two actuators to obtain improved 
performance and compares the performance to two typical actuator configurations. Chap- 
ter 1 presents the motivation and background for understanding the thesis and chapter 2 
introduces the Parallel Coupled Micro-Macro Actuator concept. 

Chapter 3 proposed several actuator performance metrics. Some of these metrics are 
well established while others are new to the area of actuator design. 

Chapter 4 provided a model of the PaCMMA system and derived a number of perfor- 
mance limits. It was shown that micro and macro-actuators in the PaCMMA system have 
limits on both frequency and amplitude. Analytic expressions for force control bandwidth, 
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position control bandwidth and impedance were derived for the PaCMMA system. A brief 
discussion of nonlinear effects is presented. 

Chapter 5 presented a control law for the system. The control law performance was 
compared to an optimal control law and was shown to be nearly optimal in some conditions 
and adequate in other operating conditions. 

Chapter 6 discussed the design parameters for the system and presented a design pro- 
cedure. As with all design procedures, the process is likely to be iterative when resolving 
the large number of simultaneous constraints. 

Chapter 7 presents the results from a large number of experiments. The data shows con- 
clusively that the PaCMMA concept is both physically realizable and effective in achieving 
the desired performance goals. 



8.3 Further Work 

The work presented here provides the starting point for understanding how two scaled 
actuators may be used in parallel to achieve better performance than a single actuator. As 
with most theses, there are a number of research directions to explore in greater detail. 

Nonlinear Transmission: The elasticity in the transmission is a fundamental characteristic 
of the PaCMMA concept. Consideration of various manipulation tasks suggests that 
the low stiffness is most important when the actuator is in the process of making 
contact with the environment. In this case, the transmission deflection is small. Con- 
versely, when the contact forces are large and the transmission is under considerable 
load, the low stiffness is not as important. This leads to the conclusion that the trans- 
mission should probably be soft when the forces are small and stiffer when the forces 
are high. The use of a nonlinear transmission will be an important extension of this 
concept. 

Compact Design: The current implementation places the micro-actuator at the endpoint 
and the macro- actuator is located some distance from the endpoint. The configuration 
shown in figure 2-2 represents a PaCMMA in a compact package. This configuration 
is obviously of interest since it can be readily connected to existing hardware. 

Control Law: The control law presented here was chosen for its simplicity and generally 
good performance across a wide range of operating conditions. There are obviously 
applications where the dynamics are less likely to change and a more specialized 
controller might yield improved performance. 

Other Actuator Technologies: Electric motors were used because of their broad popularity 
and ease of use. However, other actuators may influence the design and performance. 
Actuators with limited position range (like voice coils and hydraulic cylinders) may 
produce slightly different performance relationships. Extension of the concept to other 
actuators remains an interesting implementation project. 
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8.4 Applications 

The PaCMMA concept may be useful in a number of applications. Haptic interfaces are 
placing very large demands on actuator technology and creation of a high fidelity interface is 
a current research topic (Massie and Salisbury, 1994; Hayward, 1995; Salcudean and Wong, 
1993; Maclean, 1996). Much of this work focuses on maximizing the fidelity to human 
perception because success in this field is determined by a "Haptic Turing Test" (Maclean, 
1996). 

Unstructured environments constantly test the robustness of control laws and mechan- 
ical hardware. Impact resistance and error tolerance are of prime importance and perfor- 
mance is often defined as not breaking, rather than high speed or dexterity. 

Active tactile sensing is another area of application. The ability to sense features dy- 
namically is dependent on the ability to move smoothly, with precision in force and position. 
Effective algorithms for dynamic sensing rely on high quality actuation (Eberman, 1995). 
The quality of the information is directly related to the quality of movement. Humans 
benefit from very smooth, well damped actuation. 
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Appendix A 

Prototype Specifications 



The prototype actuator has the following specifications: 



Micro-actuator 



Maxon RE035 



Rotor inertia 67.6gmcm 2 (0.0068 mNm sec 2 ) 

Maximum Torque 114 mNm 

Position Resolution 4.36 X 10~ 4 rad/count (14400 counts/rev) 



Macro-act uator 



Maxon RE035 w/gearhead 



Reduction 

Inertia (includes gearhead) (M2) 

Maximum Output Torque 

Maximum Output Velocity 

Position Resolution 

Backlash 



36 : 1 

8mNms 2 

3.2 Nm 

14.5 rad/sec (140 RPM) 

8.72 X 10 -5 rad/count (72000 counts/rev) 

0.7 degrees 



Link Properties 



Inertia 



0.3 mNm 



Transmission 1 Steel Extension Spring 



Stiffness {K t ) 
Damping {B t ) 



1140 mNm/rad 
48 mNm/rad/sec 



Transmission 2 Steel Extension Spring 



Stiffness (K f 



3000 mNm/rad 
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Force Sensing Transducer Techniques TRT-50 



Maximum Torque 
A/D Resolution 



50 in lbs (5650 mNm) 
1.3 mNm/count 



Micro Actuator Amplifier Copley 211A 



PWM Switching Frequency 
D/A Resolution 



80 KHz 

6.1 X 10" 4 volts/count 



Macro Actuator Amplifier Copley 306A 



PWM Switching Frequency 
Amplifier Gain 
D/A Resolution 



20 KHz 

1.2 amps/volt 

6.1 X 10~ 4 volts/count 



A.l Design example 

The transfer function from micro-actuator torque to the torque sensor must be measured 
first. The connection between these two elements will become the upper limit on force band- 
width. Figure A-l shows the experimentally measured bandwidth for the micro- actuator to 
the clamped endpoint. 

This transfer function has a large resonant peak at 300 Hz. The next step of the design 
process is to apply a lowpass filter (Hiol) an d integral gain to this transfer function so 
that the resonant peak is below unity gain when the phase crosses 180 degrees. Figure A- 2 
shows the combined open loop response of the controller and the micro-actuator. 

The spring deflection can be measured and K t can be determined. For this system, 

K t = 1140mNm/rad. 

Using a series of known input torques, the inertia, Mi can also be determined. A series 
of step forces was input, the resulting accelerations measured and the best estimate for the 
macro-actuator inertia was: 

M 2 = 8mNm s 2 . 

The feedforward model for the macro-controller is obtained by measuring the macro- 
actuator transfer function, G(s) = F e (s)/F2(s), and inverting the system response. The 
function is: 



H f 



2.782s 2 +25.92s+100 



'// ~~ G[SJ ~ s 2 +20s+100 

The remaining gains to tune are Gdi, Gd2, and G p . These may be tuned by performing 
step response tests and adjusting the gains based on the response. 

Start by setting G,ii to a large value to inhibit motion of the macro-actuator. Set G,i\ 
to a large value. Set i^ es =0. Move the endpoint around very quickly. Reducing G,ii will 
reduce the impedance by increasing the velocity limit of the macro-actuator. When the 
velocity limit has been increased to an acceptable level, gain G,i\ can be gradually reduced. 
Reducing G,i\ too much will make the system unstable. The lower limit on G,i\ is more likely 
to be determined by the transmission's structural resonances and the designer's tolerance 
for noise and vibration. 

Gain G p may be gradually increased until the control effort on F\ is reduced to a value 
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Figure A-l: Micro Actuator Transfer Function. pYl - Experimentally measured by 
clamping the output shaft and doing a frequency sweep, F\ = Asm(ujt) 



close to zero. G p should not be increased arbitrarily - it will destabilize the system if it is 
too large. 
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Figure A-2: Micro Actuator and Controller. This figure shows the open loop response 
of the micro- actuator controller and the micro-actuator together. 



Appendix B 

Simulation Parameters 



Simulation of the PaCMMA system proved useful in several parts of this thesis. The 
equations derived in Chapter 4 were used with the parameters below to predict system 
performance. 

Model Parameters for Simulations and Performance Predictions 



Parameter 


Value 


Mi 


0.306 mNm sees 2 


M 2 


8.1 mNm sees 2 


K t 


1140 mNm/rad 


B t 


48.35 mNm/rad/sec 


H 10L (s) 


«4l 


s 2 +1.414w co i+wl ol 


^col 


80 Hz (502 rad/sec) 


F\sat 


114 mNm 


F2.sat 


1.0 Nm 



Control Law Gains for Simulations 

The control law in Chapter 5 was simulated with the following gains: 
Gain Value 



Gff 


1.0 


H ff 


2.782s 2 + 25.92s+100 


s 2 +20s+100 


Gdl 


70 


Gd2 


50 


G p 


4 


Gi 


100 



Augmented Model 

In order to properly simulate the inertial effects of the micro-actuator and the torque 
sensor, a third model element was added. Figure B shows the augmented model. 

For this model, the torque sensor properties were estimated from the open loop transfer 
function in figure A-l. 
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Figure B-l: Augmented Model for Simulation 



Parameter 


Value 


M t 


0.30 mNm sees 2 


M 3 


0.0068 mNm sees 2 


K u 


100000 mNm/rad 


Bu 


20.8 mNm/rad/sec 



A state-space model of the various parts of the system follows. 



PaCMMA dynamics: 
State Vector and Inputs: 



X i 

x 2 
x 2 
x 3 
x 3 
System Matrices: 

A = 



K u + K e )/M : 







K t /M 3 




and F 



B 



F 2 



(B 
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, s + B e )lM 1 




B t /M 3 
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1/M 2 
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-Kts ~B t 
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